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Abstract  of  Dissertation  Presented  to  the  Graduate  School 
of  the  University  of  Florida  in  Partial  Fulfillment  of  the 
Requirements  for  the  Degree  of  Doctor  of  Philosophy 

KINESTATIC  ANALYSIS  OF  MULTI-FINGERED  HANDS 

By 

Lotfi  Romdhane 
August  1989 

Chairman:  Dr.  Joseph  Duffy 

Major  Department:  Mechanical  Engineering 

This  work  is  concerned  with  the  handling  of  an  object  by  an  articulated  multi- 
fmgered  hand.  By  handling,  we  mean  the  secure  grasp  of  a general  object  plus  the 
manipulation  of  this  object  by  the  fingers  without  motion  of  the  arm  on  which  the  hand  is 
mounted.  Hypothetical  joints  are  used  to  express  the  freedom  at  the  contact  of  the 
object  with  each  fingertip.  A pair  of  matrices  are  introduced  that  relate  the  small 
motions  of  the  joints  to  the  relative  displacement  of  the  object  and  the  fingertips,  and  are 
derived  using  reciprocal  screws. 

This  analysis  permits  not  only  the  determination  of  the  necessary  conditions  for  a 
secure  handling  of  the  object,  but  also  the  investigation  of  the  special  configurations  that 
may  occur.  In  the  case  of  a grasp  with  point  contact  with  friction,  a very  important 
result  is  derived  which  leads  to  a considerable  simplification  in  the  analysis  of  these 
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matrices.  Further,  it  is  shown  that  there  exists  a particular  point,  called  the 
center  of  the  grasp,  at  which  the  direction  of  the  force  applied  to  the  object  does  not 
influence  the  contact  intensities.  Following  this,  it  is  demonstrated  that  the  vector 
containing  the  contact  intensities,  generated  by  a unit  couple  applied  to  the  object, 
generates  an  ellipsoid,  which  is  defined  as  the  grcisp  ellipsoid.  The  two  smaller  axes  of 
this  ellipsoid  show  where  to  place  the  contacts  to  minimize  the  contact  forces  for  a given 
task.  This  result  is  a very  important  one  because  it  yields  a quality  index  that  can  be 
used  as  a criterion  in  the  choice  between  different  proposed  grasps. 

Lastly,  a computer  software  is  developed  to  draw  a solid  model  of  the  hand  and  to 
animate  it.  Two  modes  are  available  for  the  user.  In  the  first  one,  the  user  chooses  the 
initial  and  final  position  and  orientation  of  the  grasped  object  and  a straight-line  path  is 
generated  and  displayed  on  the  screen.  In  the  second  one,  the  user  leads  the  object  to  its 
goal  position  using  the  keyboard  as  a teach-pendent.  The  path  can  then  be  previewed 
and  saved  in  a file  for  later  use. 
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CHAPTER  1 
INTRODUCTION 


Simple  two-finger  gripper  designs  that  are  commonplace  in  industry  rely  on 
friction  to  restrain  the  grasped  object.  Examples  include  parallel  finger  gripper  (Figure 
1.1)  and  pivoting  finger,  gripper  (Figure  1.2).  For  oddly  shaped  objects  complete 
restriction  might  not  be  possible  using  the  above  designs.  Inflatables  grippers  and 
snakelike  fingers  are  used  in  some  cases  to  accomodate  objects  with  intricate  shapes. 
Chen  [1982]  shows  several  gripping  mechanisms  for  industrial  robots. 

Several  difficulties  arise  when  these  kinds  of  hands  are  applied  to  flexible  - 
manufacturing  systems.  These  difficulties  prevent  industrial  robots  and  their  grippers 
from  accurately  grasping  and  manipulating  objects.  For  instance,  these  simple  gripper 
designs  are  not  well  adapted  to  a wide  range  of  object  shapes,  and  industrial  manipulators 
to  which  the  grippers  are  attached  are  usually  not  well  suited  for  both  gross  and  fine 
motion. 

The  modeling  of  the  human  hand  is  a formidable  task.  The  human  hand  is  a 
sophisticated  mechanical  system  of  muscles  and  ligaments  and  bones  with  at  least  18  joint 
articulations  with  22  degrees  of  freedom  or  more.  Nonetheless,  the  need  for  more 
versatile  end-effectors  in  robotics  has  led  more  and  more  researchers  to  design  mechanical 
hands  (Crossley  Umholtz  [1977],  Skinner  [1975],  Okada[1979],  Salisbury  [1982],  and 
Jacobson  et  al.  [1984]). 
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Figure  1.2 
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Recently,  there  has  been  a growing  interest  in  studying  multi-fingered  hands 
capable  of  manipulating  the  grasped  object,  see  for  example  Salisbury  [1982],  Kerr  [1984], 
Kerr  and  Roth  [1986],  Kobayashi  [1985],  Holzman  and  McCarthy  [1985],  Kerr  and 
Sangar  [1986],  Hanafusa  et  al.  [1983],  Cutkosky  [1985],  Nguyen  [1987a,  b],  and  Ji  and 
Roth  [1987].  In  the  work  done  by  Salisbury  [1982],  which  was  subsequently  extended  by 
Kerr  [1984]  and  Kobayashi  [1985],  a pair  of  matrices  describing  the  kinestatics 
(instantaneous  motions  and  statics)  of  the  hand  were  presented.  Kerr  and  Sanger  [1986] 
introduced  a stiffness  matrix  for  a grasp  with  elastic  contacts.  Following  this  they 
deduced  the  external  force  on  the  grasped  object  and  determined  whether  it  will  slip. 
When  slipping  occurs  the  resulting  motion  is  determined. 

In  this  work  the  matrices  derived  by  Maher  [1983]  and  Maher  and  Duffy  [1984] 
for  fully  parallel  devices  using  reciprocal  screws  are  modified  and  applied  to  the  grasping 
problem.  Whilst  these  matrices  are  similar  to  those  due  to  Salisbury,  the  method  of 
solution  for  the  grasping  problem  is  novel  and  avoids  the  use  of  the  generalized  inverse 
(Salisbury  [1982],  and  Kerr  [1984])  or  projective  matrix  techniques  (Kobayashi  [1985]) 
which  lead  to  non-invariant  results  with  respect  to  translation  of  origin  and  also  non- 
invariance with  respect  to  a change  of  scale  (see  Rico  [1988],  Griffis  [1988],  Lipkin  [1985], 
and  Lipkin  and  Duffy  [1985,  1986]). 

Briefly,  noninvariance  occurs  because  one  of  the  matrices,  which  will  be  referred  to 
cLS  the  J matrix,  is  necessarily  generated  by  a dual  vector  formulation  rather  than  by  the 
classical  matrix  formulation.  Transformations  incorporating  the  orthogonal  product  of 
dual  vectors  have  no  physical  meaning  simply  because  the  first  and  last  three  components 
of  these  vectors  have  different  dimensions.  Such  transformations  cannot  be  used  since  the 
results  are  mathematically  meaningless. 
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In  order  to  resolve  these  problems,  an  invariant  modified  singular  value 
decomposition  (MSVD)  of  this  matrix  is  presented  in  Appendix  B.  Essentially,  this  new 
method  combines  the  singular  value  decomposition  (SVD)  (Steven  [1980]  and  Beni  Israel 
et  al.  [1974])  with  the  dual  operator  (Lipkin  [1985]).  Using  this  procedure  an  analysis  of 
the  characteristic  matrix  equation  of  the  hand  revealed  the  different  special  configurations 
that  might  occur  during  motion.  Furthermore,  this  novel  method  yields,  in  the  case  of 
point  contact  with  friction,  a very  simple  yet  powerful  means  of  analyzing  these  matrices. 
The  analysis  of  the  mxn  dual  matrix  (m,n  > 6 ) reduces  to  the  analysis  of  a simple  3x3 
matrix,  which  simplifies  the  computations  tremendously.  Also  the  invariance  of  this 
method  with  respect  to  a change  of  origin  has  been  proven.  Following  this,  a force 
analysis  using  the  principle  of  virtual  work  together  with  a characteristic  matrix  equation 
yields  an  equation  relating  the  external  wrench  on  the  object  to  the  joint  torques.  It  is 
important  to  recognize  that  the  magnitude  (or  norm)  of  a screw  has  no  physical  meaning 
because  the  first  three  and  last  three  components  of  the  dual  vector  have  different 
dimensions. 

A summary  of  each  chapter  is  now  presented. 

The  objective  of  chapter  2 is  to  present  the  necessary  tools  for  the  analysis  of  the 
multi-fingered  hands.  Screw  theory  forms  the  basis  of  this  work.  A comprehensive  theory 
of  screws  and  reciprocal  screw  systems  was  first  established  by  Ball  [1900]  and  a modern 
presentation  with  application  to  mechanisms  and  robot  manipulators  is  presented  by 
Hunt  [1978].  It  is  well  established  that  a general  system  of  forces  and  couples  acting  upon 
a rigid  body  can  be  reduced  to  a wrench  acting  along  a screw  and  that  the  instantaneous 
motion  of  a rigid  body  is  equivalent  to  a twist  on  a screw.  Screw  theory  has  been  widely 
applied  to  the  analysis  of  serial  manipulators  (Hunt  [1987],  Duffy  [1980,  1983],  and  Roth 
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and  Bottema  [1979]),  but  few  (]Maher  [1983],  Salisbury  [1982],  and  Sugimoto  [1986, 
1988])  were  interested  in  parallel  mechanisms. 

In  chapter  3 a kinematic  analysis  of  multi-fingered  hands  is  presented.  Using  the 
results  of  the  previous  chapter  concerning  serial  manipulators  and  the  work  of  Maher 
[1983],  we  extended  the  analysis  to  multi-fingered  hands.  A characteristic  matrix 
equation,  = Kfi,  governing  the  relation  between  the  twist  of  the  object,  $,  and  the 

instantaneous  joint  velocities,  Q,  was  derived.  The  matrix  J corresponds  to  the  set  of 
wrenches  of  constraints  on  the  object,  imposed  by  each  contacting  finger.  Using  the 
MSVD,  developed  in  Appendix  B,  we  solved  the  characteristic  matrix  equation. 

First,  a forward  analysis  yielding  the  twist  of  the  object  as  a function  of  the  joint 
angle  velocities  is  carried  out.  This  method  uses  the  MSVD  of  the  dual  matrix  J which 
uses  the  reciprocal  product  as  the  only  product  allowed  between  screws.  This  method 
leads  then  to  invariant  results  that  are  physically  meaningful.  A reverse  analysis  of  the 
multi-fingered  hands  is  accomplished  by  inverting  the  matrix  K.  However,  if  the  latter 
matrix  is  not  square,  the  well  known  singular  value  decomposition  can  be  applied  to  solve 
for  D.  A force  analysis  using  the  principle  of  virtual  work  together  with  the  characteristic 
matrix  equation,  yields  an  equation  relating  the  external  wrench  on  the  object  to  the  joint 
torques.  This  analysis  also  uses  the  MSVD  of  the  dual  matrix  J.  A set  of  conditions 
securing  the  grasp  were  also  derived. 

Generally,  for  a single  open  serial  chain  of  links,  the  special  configurations  occur 
when  the  Jacobian  matrix  becomes  singular.  However,  in  the  case  of  a multi-fingered 
hands  special  configurations  occur  when  the  matrices  J and/or  K are  no  longer  fully 
ranked.  In  chapter  4 we  present  the  following  four  different  cases  that  may  arise: 
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• Case  1:  Rank  of  J is  less  than  6 

• Case  2:  The  matrix  K is  not  fully  ranked 

• Case  3;  K and  J are  not  fully  ranked 

• Ca^e  4:  The  matrix  K = 0 

Once  a multi-fingered  hand  has  been  built,  one  of  the  most  basic  questions  to  be 
answered  is  the  determination  of  the  best  gr8isp.  This  subject  is  treated  in  chapter  5. 
Namely,  given  an  object  together  with  a task  to  perform,  what  is  the  appropriate  grasp  of 
the  object  so  that  the  tcisk  can  be  executed  efficiently?  Obviously  different  criteria  yield 
different  results,  and  the  following  ca^es  are  examined, 

• Minimization  of  the  joint  angular  velocities  for  a given  unit  twist  of  the  object. 

• Minimization  of  the  joint  torques  (or  the  contact  intensities)  for  a given  unit 
wrench  applied  to  the  object. 

• Minimization  of  the  contact  intensities  or  angular  velocities  for  a given  grasp 
configuration.  In  the  case  of  point  contact  with  friction,  the  concepts  of  grasp  ellipsoid 
and  the  center  of  the  grasp  are  introduced.  They  prove  to  be  powerful  tools  to  help  the 
search  for  an  optimal  grasp. 

In  chapter  6,  a computer  graphics  simulation  for  a 3-fingered  hand  is  developed. 
All  the  theory  developed  in  the  previous  chapters  is  incorporated  in  this  software,  and  it 
provides  a realistic  animated  solid  model  of  the  hand.  An  algorithm  generating  a straight 
line  path,  used  together  with  a teaching  mode,  yields  a spatial  trajectory  of  the  grasped 
object.  Any  selected  motion  is  then  previewecf  on  the  screen. 

Chapter  7 contains  a summary  of  this  work,  and  some  recommendations  for 


future  work. 


CHAPTER  2 

INTRODUCTION  TO  THE  THEORY  OF  SCREWS 


2.1  The  Theory  of  Screws 

The  screw  theory  is  an  elegant  and  powerful  method  to  investigate  the  kinestatics 
(kinematic  and  static)  of  serial  and  parallel  manipulators.  In  this  chapter,  an  overview  of 
this  theory  and  its  application  to  the  analysis  of  robot  manipulators  are  presented.  First, 
screws  and  screw  systems  are  investigated.  Then,  two  important  screw  operations, 
namely  the  reciprocal  and  orthogonal  products,  are  presented. 

2.1.1  Free  Vectors  and  Line  Vectors 

An  ordinary  three-dimensional  vector  has  magnitude  and  direction,  but  a vector 
may  also  have  positional  properties.  In  particular,  two  kinds  of  vectors  occur  in  rigid 
body  kinestatics:  line  vectors  and  free  vectors. 

A line  vector,  denoted  by  £,  has  magnitude  and  direction  together  with  a location  in 
space.  The  location  of  the  line  can  be  represented  by  its  moment  with  respect  to  the 
origin.  Let  S be  3x1  vector  representing  the  direction  of  $ and  r a vector  pointing  from 
the  origin  to  a point  on  the  line.  The  moment  of  the  line  with  respect  to  the  origin  is 
given  by  the  vector  Sq 

So=  rxS  (2.1) 

While  So  is  origin  dependent,  the  vector  S is  not.  The  six-dimensional  vector  [S,Sq]^ 
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completely  describes  the  line.  Although  six  numbers  are  specified  to  describe  a unit  line 
vector,  only  four  are  independently  chosen  due  to  the  following  constraints 

So=  0 (2.2) 

ISl  = 1 (2.3) 

The  vectors  S and  Sq  can  be  combined  into  a dual  vector 


^ — S.  d* 

where  = ...=  0 

or  simply 


(2.4) 


(2.5) 


A free  vector  with  a magnitude  and  a direction  given  by  a vector  S is  adequately 
represented  by  S.-  We  can  put  free  vectors  of  the  same  algebraic  footing  as  line  vectors  by 
expressing  them  in  the  form 


$ = 


0 

s 


(2.6) 


For  a given  reference  frame  the  cartesian  coordinate  of  the  vectors  S and  So  can  be 
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written  as  follows 


L 

P 

s = 

M 

, and  ^ = rxS.  = 

Q 

N 

R 

. 

. 

Equation  (2.5)  becomes 


1 = 


L 

M 

N 

P 


Q 


R 


(2.7) 


(2.8) 


The  quantities  L,  M,  N,  P,  Q,  and  R are  called  the  Pliicker  coordinates  of  the  line.  The 
conditions  given  by  Equations  (2.2)  and  (2.3)  become 


LP  + MQ  + NR  = 0 (2.9) 

=1  (2.10) 


The  free  vector,  Equation  (2.6)  can  be  written  as 
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0 

0 

0 

L 

M 

N 


(2.11) 


2.1.2  Screws  and  Screw  Coordinates 

A screw  as  defined  by  Ball  [1900]  is  a directed  line  with  which  a linear  magnitude, 
called  the  pitch,  h,  is  associated.  A screw  is  essentially  a geometrical  concept.  Any  finite 
or  infinitesimal  displacement  of  a rigid  body  can  be  represented  in  terms  of  a twist  about 
a screw.  Similarly,  any  system  of  forces  and  couples  acting  on  a rigid  body  can  be 
replaced  by  a single  wrench  on  a screw  ( a force  and  a parallel  couple). 

The  six  Pliicker  line  coordinates  can  be  extended  to  a set  of  screw  coordinates.  If 
( L,  M,  N;  P,  Q,  R ) are  the  Pliicker  coordinates,  of  the  screw  axis  then  the  screw 
coordinates,  considering  a pitch  h,  are  ( L,  M,  N;  P*,  Q*,  R*  ) given  by 


L 

L 

M 

M 

N 

N 

P* 

P + hL 

Q* 

Q + hM 

R* 

R+hN 

(2.12) 


The  above  equation  can  be  written  also  as 


and 


(2.14) 


u ^ _ LP*  + MQ*  + NR* 

L^  + M^  + N^ 


If  the  pitch,  h,  is  zero  then  the  screw  coordinates  are  identical  to  the  line  coordinates. 
For  a screw  with  infinite  pitch,  the  direction  vector  vanishes,  S = 0 and  the  screw 
coordinates  are  identical  to  those  for  a free  vector. 

2.1.3  Screw  Systems 

A screw  system  is  a subspace  of  a six-dimensional  vector  space  over  the  real 
numbers.  A screw  is  represented  as  a 6x1  column  vector  of  the  components  in  a standard 
basis,  denoted  by  Cj,  which  comprises  three  unit  line  vectors  {§j^,  §2,  £3}  forming  the  axes 
of  the  cartesian  coordinate  frame  and  three  unit  free  vectors  {e^,  Cg,  e^}  parallel  to  the 
coordinate  axes.  Any  screw  ^ may  be  expressed  as 


where  Xj  are  the  canonical  components  of  £. 

Let  us  denote  by  Instantaneous  Screw  Axis  (ISA)  the  set  of  unit  line  vectors  and 
unit  free  vectors.  All  possible  linear  combinations  of  r (r<6)  independent  ISA’s  form  a 


(2.15) 


screw  system  of  order  r.  The  order  of  the  screw  system  of  a joint  is  its  connectivity, 
which  is  the  number  of  relative  degrees  of  freedom  of  the  bodies  connected  by  the  joint. 
Screw  systems  associated  with  revolute,  prismatic,  and  screw  joints  are  of  order  one.  The 
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screw  system  of  order  six  contains  the  set  of  all  ISA’s  which  represent  the  six  degrees  of 
freedom  of  an  unconstrained  body  in  space. 

2.1.4  Algebra  of  Screws 

The  addition  and  multiplication  by  a scalar  of  screws  obey  the  rules  of  classical 
linear  algebra.  In  this  case,  it  is  adequate  to  consider  a screw  as  an  element  of  R®.  Also 
it  can  be  proven  that  the  six-system  of  screws  is  a vector  space  (Sugimoto  Duffy 
[1982]). 

On  the  other  hand,  one  can  be  tempted  to  use  the  classical  definition  of  norm  of  a 
screw  or  the  inner  product  of  screws,  but  these  latter  concepts  seem  to  be  physically 
meaningless  (see  Lipkin  [1985],  Lipkin  & Duffy  [1986]).  The  reason  for  this  is  the  fact 
that  the  first  three  and  last  three  components  of  a screw  are  of  different  dimension.  Also, 
the  vector  So  origin  dependent,  leading  to  a different  magnitude  of  the  same  screw 
when  a change  of  origin  is  performed. 

Another  concept,  which  is  a direct  consequence  of  the  above  reasoning,  is  the 
orthogonality  of  screws.  Two  screws  Vj^  and  V2  are  said  to  be  orthogonal  if  their  inner 
product,  defined  as  VJV2,  is  equal  to  zero.  In  the  following  example  we  will  show  that 
the  property  between  the  same  two  screws  is  affected  by  the  location  of  the  fixed  frame. 

Example  2.1 

Since  line  vectors  are  a subset  of  the  set  of  screws,  this  example  uses  them  to 
show  some  results  discussed  above.  Let  and  $2  be  two  line  vectors,  (see  Figure  2.1) 
then 


Si 

IxxSi 


and 


I2  ~ 


S2 

£2  ^ —2 
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Figure  2.1 


Addition  of  Screws 


S1+S2 


1 + ^2  ~ 


IixSi  + r2xS2 


Note  that  the  screw  $ is  not  necessarly  a line  vector  (hytO),  but  it  is  a general  screw. 
Multiplication  by  a Scalar 


^ — 


ASi 

X S ^ 


The  screw  $ is  still  a line  vector  but  is  not  unitized  in  this  case. 

Inner  Product  of  Screws 

A = i[$2  = SJS2  + So^  S02 

= S 1 S2  + (lixSi)’’’  (12XS2)  (2.16) 

When  the  scalar  A = 0,  the  two  screws  are  said  to  be  orthogonal.  A change  of  origin 
induces  a change  of  the  representation  of  the  two  line  vectors  and,  specifically,  the  vectors 
S^j^  and  ^02* 


Origin  in  0 

Origin  in  A 

where  OA  = a 

^0  X — — X^“l’  So2~”  To  X 

Soi=(li  — a)xSi,  and  So2=(l2~3;)^S2 

Si  S.2  + (liXSi)'^  (l2=<S2) 

^'=Sj  S2  + ((ri— a)xSi)^  ((l2~a)xS2) 
a'  = A - (axSi)’^(£2xS2)  - 

(ax  82)^(11x81)  + (axSi)^(axS2) 
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Notice  that  when  the  two  line  vectors  are  orthogonal,  i.e.  A = 0,  A^^O.  Thus,  the  property 
of  orthogonality  between  screws  is  made  origin  dependent  by  this  kind  of  inner  product. 
These  considerations  rule  out  the  use  of  this  kind  of  inner  product  to  analyze  screws. 
Instead,  the  reciprocal  product,  introduced  in  the  following  section,  is  physically 
meaningful  and  it  is  invariant  with  the  change  of  origin.  In  this  dissertation,  the 
reciprocal  product  is  the  only  product  used,  which  leads  to  some  interesting  and  novel 
results  in  the  analysis  of  multi-fingered  hands. 

2.1.5  Reciprocal  Screws 

The  reciprocal  product  '3*^2  of  two  screws  and  ^2>  defined  as 

^12“  Si"  So2  + Sj  S.01  (2.17) 

where 


il  — 


and 


Two  screws  are  said  to  be  reciprocal  if  and  only  if  their  reciprocal  product  '^12  is  equal  to 
zero. 

It  is  more  convenient  to  write  ^P^2  as 


g»12=  h 


where  A is  6x6  matrix  introduced  by  Lipkin  [1985] 


(2.18) 


A = 


0 


(2.19) 
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In  the  case  of  two  line  vectors  (see  Figure  2.1) 


$1  _ 


Si 

ii^S] 


, and 


1.2  ~ 


S2 


^2  ^—2 


^12^  called  also  the  mutual  moment  of  the  two  lines,  can  be  expressed  as  follows 


^12  — Sl(l2^S2)  + 


= (li-r2)’^(SixS2) 

— ■“  2 ) 

(2.20) 

where 

Si  XS2 
■ IS1XS2I 

(2.21) 

a^2  = the  perpendicular  distance  (see  Figure  2.1)  between  and  $2,  and 
Ofj^2  = the  angle  between  and  ^2* 

For  the  mutual  moment  of  two  lines  to  be  zero,  they  have  to  be  either  parallel  (aj^2==0) 
or  intersecting  (a^2=t)). 

For  the  general  case  of  two  screws,  the  reciprocal  product  'iPj^2  from  Equation  (2.17)  can 
be  written 


'^12  — Si"  (l2^S2  + ^21.2)  "h  Sj  (li^S.1  + hj^Sj^) 
— (11—12)''' (£1^12)  + (hi  + h2)Si  S2 
^12  ~ aj^2sin(oj^2)  + (h + h2)cos(oj^2) 


Two  screws  are  said  to  be  reciprocal  if  and  only  if  ^^2  = 0- 


(2.22) 

(2.23) 

(2.24) 
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2.2  Introduction  to  the  Kinestatics  of  Rigid  Bodies 
2.2.1  Instantaneous  Kinematics  of  a Rigid  Body 

A revolute  joint  has  an  axis  about  which  the  rotation  is  possible.  The  ISA  may  be 
represented  by  a line  vector.  This  line  vector  spans  the  screw  system  associated  with  the 
revolute  joint.  A prismatic  joint  is  characterized  only  by  its  direction,  so  its  ISA  can  be 
represented  by  a free  vector,  which  spans  the  associated  screw  system.  A screw  joint 
combines  rotation  and  translation,  so  it  can  be  represented  by  a line  vector  and  a free 
vector. 


Example  2.2 

Let  bj^  be  a body  having  a pure  rotation  around  and  a pure  translation  T2 
along  ^2?  with  respect  to  body  b2  (see  Figure  2.2).  The  resulting  motion  can  conveniently 
be  represented  by  a screw  such  that 


Si 

0 

+ ^2 

Sol 

S2 

(2.25) 


= Wj^Sj 

wSo  — T ”^2—2 

since  1^1  = jS^I  = 1 

we  get  w = 

S = Si 

T 

So=  IiXS.1  + t^S.2 


(2.26) 

(2.27) 

(2.28) 

(2.29) 

(2.30) 

(2.31) 


h = 


_ar  Sc 


S^  S 


Ball  called  this  motion  a twist 


of  amplitude  w on  a screw  $. 


(2.32) 
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Figure  2.2 
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2.2.2  Statics  of  a Rigid  Body 

Analogous  to  instantaneous  motions,  unit  line  vectors  can  be  used  to  express  the 
action  of  a force  an  a body.  A line  vector  with  magnitude  f and  direction  given  by  ^ 
acting  in  the  line  passing  through  P (rp  = OP)  is  given  by 


fl  = 


fS 

flpxS 


(2.33) 


A pure  couple  has  no  line  of  action,  and  may  therefore  be  represented  as  a free  vector.  A 
general  system  of  forces  and  couples  acting  upon  a rigid  body  can  be  reduced  to  a single 
force 


fill  = fi 


Si 

IixSi 


with  a pure  couple 


(2.34) 


(2.35) 


This  force-couple  combination  is  represented  by  such  that 
f=fl 
S = Si 

So  = IiXSi  -f  ^§2 
h = ^Si'^  S2 

Ball  called  this  resulting  quantity  a wrench  of  intensity  f on  a screw  $. 


(2.36) 

(2.37) 

(2.38) 

(2.39) 
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2.2.3  Serially  Connected  Manipulators 

This  analysis  is  best  described  by  an  example. 

Example  2.3 

Given  three  bodies  bg,  bj^,  and  b2.  bj^  has  a relative  motion  with  respect  to  bQ 
represented  by  and  body  b2  moves  with  respect  to  b^  along  a screw  W2$2' 

instantaneous  motion  of  b2  with  respect  to  bg  is  given  by  the  screw  (Duffy  [1980]) 

+ W2$2"  (2.40) 

This  result  can  easily  be  generalized  to  a serial  manipulator  with  n links 


where  represents  the  motion  of  the  end  effector  with  respect  to  the  ground.  On  the 
other  hand,  the  screw  a^jSj  represents  the  relative  motion  of  the  i*'*^  link. 

Serial  manipulators  are  basically  a succession  of  links  connected  together  by  joints 
(usually  revolutes  or  prismatics).  The  first  link  is  usually  referred  to  as  the  base  and  is 
always  fixed  to  a reference  frame.  The  last  link  is  called  the  end-effector  of  the  robot. 

Example  2.4 

Figure  2.3  illustrates  a typical  industrial  serial  manipulator:  the  PUMA  robot. 

Given: 

• The  location  of  the  end-effector  Rp  = [33,8,4]^  (in),  pointing  to  a point  P,  and  its 
orientation  which  can  be  represented  by  a^y  =[0,1,1]^  and  Sg  = [0,l,— 1]^, 
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Figure  2.3 
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• The  absolute  velocity  Vp  = [10,  — 20,30]^(in/s)  of  a point  P located  on  the  end- 
effector  and  the  angular  velocity  w = [100,  — 150,50]^  (deg/s)  of  the  end-effector. 

Find:  The  joint  angular  velocities  Wj’s  required  to  generate  (w,Vp). 

The  motion  of  the  end  effector  can  be  represented  by  a screw  w$  where 


w 

Q 

= 

RpXuj 

-b 

Vp 

1.75 

-2.62 

.87 

27.45 

-41.82 

-70.36 


rad/s 


in/s 


(2.42) 


(2.43) 


Since  the  end-effector  is  serially  connected  to  the  base,  the  screw  equation  of  its  motion 
can  be  written  as  follows: 


u;i=  ^Wjij 


Equation  (2.44)  can  be  written  in  matrix  form 


(2.44) 


u;^=  jn 


(2.45) 
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where 


J = 

1 1 

^2 

I3 

I4 

is 

1 — 1 

0 

.42 

.42 

.74 

0 

1 

0 

-.91 

-.91 

.34 

-.87 

0 

J = 

1 

0 

0 

-.59 

.5 

0 

0 

0 

6.4 

-5.4 

3.2 

0 

0 

0 

2.9 

14.2 

-13.4 

-2.3 

0 

0 

-14.8 

1.4 

-23.4 

-10.4 

J is  called  the  Jacobian  matrix  of  the  robot. 


Wi 

"2 

‘^3 

W4 

‘^5 

‘^6 


(2.47) 


Solving  for  the  joint  angular  velocities  Wj’s  from  Equation  (2.45),  yields  the  following 
results 


-45.75 


-18.12 


Q = 


112.46 

-149.20 


deg/s 


-16.17 

170.58 


24 


2.2.4  Twists  of  Freedom  and  Wrenches  of  Constraint 

The  freedom  of  a rigid  body  can  be  represented  by  a screw  system.  A basis  of  this 
screw  system  represents  all  the  possible  motions  of  this  rigid  body.  An  unconstrained 
rigid  body  in  space  has  six  degrees  of  freedom,  thus  its  motion  is  represented  by  a linear 
combination  of  a basis  of  the  six-system.  Adding  n constraints  on  this  rigid  body  leads  to 
a reduction  of  the  number  of  its  degrees  of  freedom  (DOF)  to  (6  — n).  A (6  — n)-system 
can  be  found  to  represent  any  motion  of  the  constrained  rigid  body.  The  remaining  n 
degrees  of  freedom  are  now  replaced  by  n constraints.  Each  constraint  can  be  represented 
by  a wrench  on  the  constrained  rigid  body  which  is  reciprocal  to  each  and  every  element 
of  the  (6  — n)-system  of  freedom. 

In  conclusion,  the  6-sytem  of  screws  can  be  divided  in  two  subspaces  one 
representing  the  twists  of  freedom,  and  the  second  representing  the  wrench  of 
constraints. 

Example  2.5 

Figure  2.4  illustrates  a constrained  rigid  body.  The  insertion  of  the  peg  in  the 
hole  can  be  described  using  the  twists  of  freedom  and  the  wrenches  of  constraint. 

Twists  of  freedoms: 


A rotation  around  the  z-axis 
A translation  along  the  z-axls 
Wreches  of  constraints: 

A force  along  the  x-axis 
A force  along  the  y-axis 
A couple  around  x-axis 


Xi=  [0,  0,  1;  0,  0,  0]^ 

X2=  [0,  0,  0;  0,  0,  l]"^ 

Wi=  [1,  0,  0;  0,  0,  O]"" 

W2=  [0,  1,  0;  0,  0,  O]"^ 
W2=  [0,  0,  0;  1,  0,  O]"^ 
W2=  [0,  0,  0;  0,  1,  0]^ 


A couple  around  y-axis 
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T 

-1 


Figure  2.4 
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In  this  example,  the  peg  has  two  DOF,  and  its  motion  is  represented  by  a two-system 
spanned  by  Tj^  and  X2.  The  4-system  spanned  by  {Wj^,  W^.  W3,  W4}  repesents  the 
constraints  imposed  by  the  environment.  It  also  represents  the  wrenches  that  can  be 
transmitted  from  the  environment  to  the  object  without  inducing  any  motion.  Notice 
that  each  twist  T is  reciprocal  to  all  the  wrenches  Wj’s,  which  means  that  applying  a 
wrench  ^ to  the  peg  does  not  produce  any  virtual  power  (Lipkin  ^ Duffy  [1986],  and 
Griffis  [1988]). 

This  hybrid  decomposition  of  wrenches  of  constraints  and  twist  of  freedom  was 
the  subject  of  many  discussions  during  the  last  decade.  Mason,  with  his  concept  of 
“natural”  and  “artificial”  constraints,  used  the  concept  of  geometric  segregation  of 
Cartesian  axes  to  generate  the  required  hybrid  decomposition  (Mason  [1978,  1979]). 
Also,  he  defined  the  center  of  compliance  as  the  origin  of  cartesian  axes.  Several  authors 
tried  to  apply  this  theory  to  control  robot  manipulators  (Raibert  & Craig  [1981],  Brady 
et  al.  [1982],  Asada  & Soltine  [1986]).  However,  Paul  [1987]  and  Ann  & Hollerbach 
[1988]  have  shown  through  simulation  as  well  as  experimentation  that  this  method  of 
segregation  yields  unsatisfactory  results. 

In  later  work,  Lipkin  [1985],  Lipkin  & Duffy  [1986]  and  Griffis  [1988]  showed  that 
this  decomposition  is  meaningless  due  to  the  use  of  the  erroneous  orthogonal  product 
between  screws  (see  Section  2.1.4).  They  also  showed  that  the  reciprocal  product  is  the 
only  product  to  be  used  between  them.  Furthermore,  Griffis  [1988]  showed  that  other 
considerations  must  be  addressed  to  have  a complete  and  a meaningfull  hybrid 
decomposition. 


CHAPTER  3 

KINESTATICS  OF  MULTI-FINGERED  HANDS 

3.1  Introduction 

The  main  task  of  a hand  is  handling  an  object.  By  handling  we  mean  grasping 
and  manipulating  an  object  using  a set  of  fingers.  The  fingertips  are  the  only  contact 
between  the  fingers  and  the  object.  The  motion  of  the  grasped  object  is  generated  using 
the  finger’s  joints.  During  this  process  the  platform  supporting  the  fingers,  also  called  the 
palm,  does  not  move. 

In  this  section,  a general  hand  of  M fingers  having  N joints  each,  is  investigated. 
A kinematic  and  a force  analysis  of  the  hand  are  developed.  An  example  of  a hand  with 
M=3  and  N=3  is  chosen  cls  a case  study. 

3.2  Type  of  Contact 

Figure  3.1  shows  a model  of  one  finger  contacting  an  object.  Although  several 
types  of  contacts  between  the  object  and  the  finger  can  be  considered  (see  Salisbury 
[1982]),  only  point  contacts  with  friction  will  be  considered  in  this  analysis.  This  choice 
stems  from  the  feEisablity  and  simplicity  of  this  kind  of  contact.  The  kinematic  analysis 
of  a hand  with  this  type  of  contact  is  investigated  in  the  following  section. 

3.3  Instantaneous  Kinematics  of  Multi- Fingered  Hands 
3.3.1  Basic  Equation 

Duffy  [1980]  modeled  a spherical  joint  by  three  concurrent  revolutes.  Using  this 
model,  we  can  model  a finger  having  a point  contact  with  the  object  as  a serial 
manipulator  where  the  last  three  joints  are  three  revolutes. 
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The  twist  £ ( = w^  ),  representing  the  instantaneous  motion  of  the  grasped  object 
of  an  M-fingered  hand  can  be  expressed  as  a linear  combination  of  the  N joint  twists  and 
the  three  contact  twists  in  any  of  the  fingers  (see  Figure  3.2)  (see  Maher  & Duffy  [1984]) 


Joint  twists 


Contact  twists 


(3.1) 


i = 1 ...  M, 

where  denote  the  N known  input  scalar  multipliers  (n  = l,...,N). 

The  M simultaneous  equations  can  be  either  solved  for  the  screw  motion  ^ or  the 

joint  angular  velocities  There  are  NM  joint  angular  velocities,  Wn\  that  are 

controllable  (each  one  of  these  joints  has  a motor).  For  the  case  of  three  fingers  and  each 
finger  has  three  joints,  we  have  3x3  = 9 joint  angular  velocities  to  solve  for. 

3.3.2  The  Characteristic  Matrix  Equation 

In  each  finger  there  are  3 unknown  scalar  multipliers,  wn\  where  j=  N + 1,  N + 2, 

N + 3,  and  it  is  necessary  to  eliminate  these  unknowns.  This  is  accomplished  by  forming  a 

3-system  of  screws  which  is  reciprocal  to  the  three-system  of  screws  corresponding  to  the 
point  contact.  Taking  the  reciprocal  product  of  both  sides  of  Equation  (3.1)  with  the 
appropriate  reciprocal  screw  for  i=  1,...,  M,  and  j=  N-l-1,  N + 2,  N+3,  gives  3M 

linear  equations.  This  set  of  3M  equations  can  be  written  in  matrix  form  as  follows: 


JTAi=  KQ 


(3.2) 


where 
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Figure  3.1 
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T _ r (tCD  0.(1)  <{(1)  «(M)  <5(M)  »(M) 

j — I irl  2-r2  ^3  ■■•  ^r2  ^r3 


(3.3) 


K = 


0 0 0 
0 0 0 


0 0 


0 0 0 K 


(M) 


(3.4) 


k(‘>  = 


ifrAiSi^ 


(3.5) 


fi  = 


.(1) 


u 


(1) 


(M) 


(3.6) 


A = 


0 I, 


(3.7) 


and  where 


J is  a 6x3M 


dual  matrix 
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A is  a 6x6 
K is  a 3MxNM 
is  a NMxl 
$ is  a 6x1 


matrix  given  by  equation  (3.7) 

matrix 

vector 

dual  vector. 


Equation  (3.2)  describes  the  instantaneous  kinematics  of  a multi-fingered  hands 
and  gives  the  geometrical  and  analytical  conditions  for  special  configurations.  This 
equation  will  be  referred  to  as  the  Characteristic  Matrix  Equation  of  the  hand. 

When  K is  a square  matrix  it  can  be  inverted  to  express  directly  in  terms  of  the 
screw  $ representing  the  motion  of  the  object.  However,  this  is  not  usually  the  ca.se  for 
grasping,  and  when  K is  a non-square  matrix  the  well  established  Singular  Value 
Decomposition  (SVD)  method  is  used  to  solve  for  (Steven  [1980]  and  Appendix  A).  It  is 
intersting  to  note  that  this  procedure  yields  important  information  on  singularities 
(special  finger  configuration). 

It  is  important  to  recognize  that  the  dual  matrix  J cannot  be  analyzed  using 
classical  linear  algebra.  This  difficulty  is  overcome  here  by  introducing  a Modified 
Singular  Value  Decomposition  (MSVD)  for  the  matrix  J (see  Appendix  B).  This  solution 
is  valid  when  J is  square  or  non-square  matrix.  Generally,  the  matrix  J represents  the 
contact  wrenches.  For  example  a single  point  contact  with  friction  permits  three 
rotations.  There  are  three  wrenches  (forces)  reciprocal  to  this  instantaneous  motion. 
Hence,  for  three  fingers  in  point  contacts  the  matrix  J will  be  6x9. 

The  MSVD,  presented  here,  not  only  yields  invariant  solution  for  $ and  important 
information  on  singularities  (special  grasping  configurations)  but  also  it  yields  the 
optimum  motion  of  the  grasped  object. 
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The  solution  of  the  characteristic  matrix  equation  for  the  screw  $ yields  the 
forward  solution.  On  the  other  hand  the  reverse  solution  yields  an  expression  of  the  joint 
angular  velocities,  £2,  in  terms  of  the  screw 
3.3.3  Reverse  Solution 

In  most  viable  grasping  situations,  the  K matrix  has  more  columns  than  rows 
(each  finger  has  at  leaat  3 joints;  N>3).  Applying  the  SVD  (see  Appendix  A)  of  the  fully 
ranked  matrix  in  Equation  (3.2)  gives  the  following  novel  expression  for  the  joint 
velocity  vector  fi. 


Q = + V2Y 

where  — VBU''' 

and  Vj  is  a NMx3M 


(3.8) 


Orthogonal  matrix 
(Vj^tVj=  Identity  matrix) 

Orthogonal  matrix 
(V2’^V2=  Identity  matrix) 

Diagonal  matrix 
Orthogonal  matrix 
Arbitrary  vector. 

This  is  an  explicit  expression  for  the  joint  velocity  vector  fi  in  terms  of  the  twist  $ 
representing  the  instantaneous  motion  of  the  grasped  object.  When  the  object  is 
stationary,  0 then  D = V2Y  is  different  from  zero  since  the  vector  Y is  arbitrary. 
This  result  is  meaningful  because  it  quantifies  the  redundancy  in  the  hand  viz.  Y consists 
of  (N  — 3)M  free  parameters  and  therefore  the  hand  possesses  (N  — 3)M  degrees  of 
redundancy.  Redundancy  is  desirable  because  it  permits  more  flexibility  in  the  grasping 


V2  is  a NMx(N— 3)M 

Bj^  is  a 3Mx3M 
Uj^  is  a 3M x3M 
Y is  a (N— 3)Mxl 
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operation.  There  will  be  in  general  hand  configurations  for  a specified  location 

of  the  object.  Clearly,  when  (N-3)M  = 0 and  there  is  no  redundancy  then  there  is  only  a 
single  hand  configuration  (oo°  = l).  A hand  with  three  joints  in  each  finger  is  relatively 
ecisy  to  control  since  it  has  no  flexibility.  Hands  with  fingers  with  number  of  joints 
greater  than  three  will  have  more  flexibility  but  the  control  will  be  difficult.  From  here  on 
only  fingers  with  three  joints  will  be  considered  (N=3)  unless  otherwise  mentioned. 

3.3.4  Forward  Solution 

Applying  the  MSVD  of  the  matrix  J in  Equation  (3.2)  yields  the  expression  of  the 
twist  $ of  the  grasped  object  directly  in  terms  of  the  joint  angular  velocity 


$ = 

together  with 

0 = vJq 

where  (see  Appendix  B) 


J = UV[ 


U is  a 6x6 
Bj  is  a 6x6 
is  a 3Mx6 


V2  is  a 3Mx(3M— 6) 


(3.9) 


(3.10) 


(3.11) 


Dual  matrix 
Diagonal  matrix 
Orthogonal  matrix 
(Vj^Vj^  = Identity  matrix) 

Orthogonal  Matrix 
(Vj V2  = Identity  matrix) 

Equation  (3.9)  can  be  used  to  compute  the  actual  motion  of  the  grasped  object  and  this 
can  be  compared  with  the  specified  motion  in  order  to  generate  an  error  signal  for  a 


controller. 
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Equation  (3.10)  consists  of  (3M— 6)  linear  equations  which  relate  the  scalar  multipliers 
flj  \ There  are  only  ever  six  free  choices  in  the  For  instance,  for  the  three  fingers 

M=3,  there  are  nine  and  Equation  (3.10)  yields  three  linear  equations,  which 

results  in  only  six  free  choices  of  the  scalar  multipliers  fij'\ 

3.4  Force  Analysis 

3.4.1  Grasp  Analysis 

A set  of  torques  r must  be  generated  by  the  joint  motors  to  resist  any  external 
wrench  W applied  to  the  object. 


(3.12) 


W = 


(3.13) 


The  rate  of  virtual  work  (or  virtual  power)  can  be  expressed  instantaneously  as 


QJt  = i^AW 


(3.14) 


Using  the  forward  solution  of  Equation  (3.2)  yields 


T = KT(ViBi^UTAW  + Vjo) 


(3.15) 
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where  a is  an  arbitrary  (3M  — 6)xl  vector. 


a 


“2 


“3 


(3.16) 


The  right  side  of  Equation  (3.15)  has  two  terms,  the  first  of  which  is  a set  of  reaction 
(manipulation)  torques  due  to  the  external  wrench  whilst  the  second  is  a set  of  torques 
due  to  the  grasping  wrenches.  We  will  be  refering  to  these  two  components  as  the 
manipulating  torque  and  the  grasping  torque,  respectively. 

3.4.2  Contact  Force  Analysis 

An  in  depth  study  of  the  wrenches  transmitted  by  different  types  of  contact  has 
already  been  investigated  by  Salisbury  [1982]  and  will  not  be  repeated  here. 

The  external  wrench  W on  an  object  grasped  by  three  fingers  can  be  expressed  in 
the  following  form: 


W = ...  + 


(3.17) 


where  *,  W3  ^ are  three  linearly  independent  contact  wrenches  with  intensities 

Ci'\  C2*\  and  Cg^  respectively  due  to  the  contact  of  the  i*'^  finger.  For  a point  contact 
with  friction  these  contact  wrenches  are  simply  three  forces.  ^ will  denote  the  force 
normal  to  the  plane  of  contact  whilst  and  are  in  the  plane  of  contact. 


However,  for  a soft  contact  the  contact  wrenches  consist  of  three  forces  together  with  a 
couple  which  is  normal  to  the  contact  plane  (see  Salisbury  [1982]). 

At  each  contact  the  wrenches  Wo^.  W3  ^ are  reciprocal  to  the  twists  allowed  by 

the  contact,  and  therefore  (see  also  Equation  (3.3)) 


J = [ 

,.(1) 

••• 

^3] 

(3.18) 

J = [ 

... 

(3.19) 

Therefore  Equation  (3.17) 

can  be  expressed  in  the  form 

W = Jc 

(3.20) 

Solving  Equation  (3.21)  for  c,  using  the  MSVD  of  J (see  Appendix  B)  yields  the 
following  explicit  expression  for  c 


c = V^Bi^UTAW  + ¥30 


(3.22) 
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Further  comparing  (3.22)  and  (3.15)  yields 


L = KTc  (3.23) 

By  analogy  with  Equation  (3.15),  Equation  (3.22)  has  two  components  of  c,  of  which  the 
first  is  generated  by  the  external  wrench  and  the  second  is  necessary  for  the  grasp. 

c = Cm  + Cg  (3.24) 

where 

cm=  ViB'i^UTAW  (3.25) 

and 

cg=  V2«  (3.26) 


3.4.3  Optimization 

In  order  to  secure  the  grasp  the  following  conditions  must  be  satisfied  (Kerr 

[1984]): 

• The  intensities  of  the  normal  forces  have  to  be  positive.  The  normal  forces 
are  i=  1 ...  3.  The  corresponding  intensities  thus  satisfy 


cj'^  > 0 for  i=  1 ...  3.  [I] 


(3.27) 


• For  no  slipping  at  the  contact  we  need  the  following  conditions 


14'1  < 


(3.28) 
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m 


(3.29) 


for  i=  1 ...  3. 

where  /i  is  the  coefficient  of  friction. 

The  vector  a must  satisfy  the  above  conditions  for  the  grasp  to  be  possible.  In  the 
case  of  three  fingers  with  point  contact  the  matrix  V2  is  9x3  and  the  above 
conditions  can  be  written  as 


Since  conditions  and  contain  the  absolute  value,  they  can  be  replaced  by  two 
conditions  each 


Vjo  = c - Cm 


(3.30) 


2 


3 


2" 


(3.31) 


(3.34) 


(3.32) 


(3.33) 


In  total,  there  are  3 conditions  given  by  [I]  and  6 by  and  6 by  [^.  This  set  of  15 


linear  inequalities  can  be  solved  using  the  simplex  method  of  linear  programming. 


The  problem  can  be  formulated  in  a matrix  form  as 


.X  a < '3B 


(3.35) 


where 
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Vj2-/iVji 

-Vj2-/iVji 

V32- 

-VJ2-  mVJi 


A 


V 


27 


(3.36) 


V2j  denotes  the  column  of  the  matrix  V2 


^m3'^^^rn3 


c 


2 

ml 


(3.37) 


c 


3 

ml 


The  objective  function  to  be  minimized  is  the  sum  of  the  normal  contact  intensities 


min  C = min(  c^^^  + c^^  + c^^^) 


(3.38) 
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which  can  be  expressed  in  terms  of  a as 


min  C — min[  ( VJi  + V T'l  V 27  ) SL  ] 


(3.39) 


This  linear  optimization  is  just  an  approximation  of  the  real  problem  (see  Kerr 
[1985])  since  conditions  and  are  a linearization  of  the  following  law 


.(i) 


< /i  N 


(i) 


(3.40) 


where 


is  the  tangential  force  at  the  i*'^ 


contact 


.(i) 


= ](4't+  (4'7 


(3.41) 


and 


is  the  normal  force  at  the  same  contact 


N 


(i) 


(3.42) 


Example  3.1 

Consider  an  object  grasped  by  three  fingers,  and  subject  to  its  own  weight, 


which  can  be  represented  by 
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0 

0 

4 

0 

0 

0 


(3.43) 


and  the  coefficient  of  friction  is  equal  to  0.333,  the  matrix  J is  given  by 


-1  0 0 0 1 0 0 -1  0 
010100-100 
0 0 1 0 0 1 0 0 1 

00000  -1  001 
00  -1  000000 
0 1 0 0 1 0 0 1 0 


The  MSVD  of  the  matrix  J is  given  by 


J = UV]" 


where 


0 -1.2  0 0 -1.22  0 
0 0 1.22  1.22  0 0 

-1.22  0 0 0 0 -1.22 

0 1 0 0-1  0 

.41  0 -.577  .577  0 .41 

1.15  0 .41  .41  0 -1.15 
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0 

.41 

0 

0 .41 

0 

.29 

0 

.41 

0 0 

-.29 

-.41 

0 

.58 

-.58  0 

-.41 

-.14 

0 

.41 

.41  0 

.14 

.43 

-.41  0 

0 -.41  -.43 

-.41 

-.5 

-.29 

.29  .5 

-.41 

.14 

0 

-.41 

-.41  0 

-.14 

.43 

.41 

0 

0 .41 

.43 

-.41 

.5 

-.29 

.29  -.5 

-.41 

.23 

.04 

-.78 

-.63 

-.23 

-.19 

0 

0 

0 

.09 

.78 

.06 

.43 

.13 

.29 

0 

0 

0 

-.55 

.55 

-.13 

.2 

.09 

.49 

0 

0 

0 

B=  diag(-2.83,  -2.45,  -1.41,  1.41,  2.45,  2.83) 


43 


From  Equation  (3.25) 


£m 


0 

0 

0 

0 

0 

2 

0 

0 

2 


and  the  optimization  process  on  Equation  (3.35)  yields 


a 


6 

5.95 

1 


and  using  Equation  (3.26),  we  get 


.1 

-.03 


0 

6.03 

.07 

0 

6 


-.03 


0 
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and 


.1 

-.03 

0 

6.03 


£ — £m  + £g 


-.07 

2 

6 

.03 

2 


This  is  the  set  of  minimum  contact  intensities  necessary  to  securely  grasp  the 
object. 

Notice  that  the  value  of  c^^^  is  not  zero  due  to  an  artificial  constraint  which 
sets  the  minimum  value  of  the  normal  forces  to  0.1.  This  condition  assures  a 
permanent  contact  between  the  fingertip  and  the  object. 


CHAPTER  4 

SINGULARITIES  AND  SPECIAL  CONFIGURATIONS 


The  term  “Special  Configuration”  was  introduced  by  Hunt  [1978]  and  it  is  used  to 
describe  various  unique  geometrical  phenomena  which  occur  in  the  motion  of  planar  and 
spacial  mechanisms.  An  in  depth  discussion  of  the  special  configuration  of  serial 
manipulators  can  be  found  in  Duffy  [1981]  and  Maher  [1983].  A brief  discussion  of  this 
subject  is  presented  in  the  next  section. 

4.1  Special  Configurations  of  Serial  Manipulators 

Generally,  for  serial  manipulators,  these  special  configurations  could  be 
categorized  into  “Stationary  Configurations”  and  “Uncertainty  Configurations”.  In 
addition  to  these  two  types,  an  arrangement  of  the  link  lengths  may  form  an  immovable 
structure(see  Figures  4.1,  4.2,  and  4.3).  Notice  that  the  stationary  configuration  is  the 
one  more  likely  to  happen  during  a path  planning  process  also  the  immovable  structure 
case  is  usually  of  no  interest  because  it  occurs  only  under  rare  circumstances. 

4.1.1  Stationary  Configurations 

A stationary  configuration  is  referred  to  sometimes  as  an  “extreme-range  position” 
(Duffy  & Sugimoto  [1981]).  A stationary  configuration  of  the  planar  four  link  mechanism 
are  widely  understood  and  one  such  configuration  is  illustrated  by  Figure  4.1. 

This  stationary  configuration  can  be  explained  using  the  screw  equation,  given  by 
Equation  (2.40)  which  is  written  here  for  a four  bar  mechanism  as  follows 
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Figure  4.1 


Figure  4.2 


$ 


1 


<©> 


Figure  4.3 
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+ W2^2  "t"  *^3^3 


(4.1) 


The  ISA  (Instantaneous  Screw  Axis)  of  ^2  ^^3  all  lie  in  the  same  plane  in  this  case. 

The  three  screws  thus  belong  to  a two-system  and 


0 — d"  ^2^2  ^3^3 


(4.2) 


Comparing  (4.1)  and  (4.2), 


u> 


4^  — Q 


(4.3) 


Therefore,  ^4=0  and  if  a;4£4  represents  the  instant  motion  of  the  end-effector  (link  a34) 
of  a 3R  planar  robot  maniplator  then  the  end-effector  is  stationary. 

The  stationary  configuration  of  a serial  spacial  mechanism  is  very  similar  to  its 
planar  conterpart  which  is  in  this  ca^e  a 6R  serial  manipulator  and  its  equivalent  7R 
closed  loop  mechanism  (Duffy  [1980]).  The  screw  equation  in  this  case  is  given  again  by 
Equation  (2.43)  or  (2.44)  and  is  written  here  as 


(4.4) 


When  the  rank  of  J=[$i  $2  $g]  becomes  less  than  six  meaning  that  the  six  screws  are 

linearly  dependent,  we  can  write 


48 


and  comparing  (4.4)  and  (4.5) 


w-^^7  — 0 


(4.6) 


— W7$7  represents  the  motion  of  the  end-effector  of  a 6R  serial  manipulator  which  is 
stationary  in  this  configuration.  This  configuration  is  also  an  extreme-reach  position  for 
the  robot  and  the  end-effector  is  laying  on  the  boundary  of  its  workspace  (see  Sugimoto  & 
Duffy  [1981]). 

In  some  cases  two  or  more  joints  can  become  stationary  at  the  same  time.  In 
general,  when  any  n screws  of  a single  loop  mechanism  with  j joints  become  linearly 
dependent  instantaneously,  then  the  n screws  form  a configuration  with  mobility  one. 
The  remaining  (j  — n)  linearly  independent  screws  form  a configuration  which  cannot  move 
instantaneously.  The  mechanism  is  said  to  be  in  stationary  configuration  which  can  be 
determined  by  monitoring  all  the  6x6  determinants  of  the  following  7x6  matrix 


(4.7) 
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A joint  is  inactive  when  the  6x6  determinant  which  does  not  include  the  row  is 
zero. 

4.1.2  Uncertainty  Configurations 

Here  again  we  illustrate  this  case  by  an  example  of  four  bar  planar  mechanism. 
Consider  that  the  axes  of  all  screws  representing  the  joint  motions  of  the  4R  mechanism 
lie  in  the  same  plane  a.s  illustrated  by  Figure  4.2,  and  that  the  input  link  is  being  driven 
at  constant  velocity  in  counter-clockwise  direction.  The  resulting  motion  of  the 
coupler  link  a.2^  is  instantaneously  uncertain  because,  depending  on  the  inertial  loading  on 
the  system,  it  may  rotate  either  clockwise  or  anti-clockwise.  The  mechanism  is  said  to  be 
in  an  uncertainty  configuration. 

In  this  case  the  four  screws,  representing  the  4R  belong  to  a two  system  because 
they  all  lie  in  one  plane.  Therefore,  the  screw  equation,  given  by  (4.1)  and  rewritten  here 
as 


— (4-8) 

is  equivalent  to  only  two  equations  in  the  three  unknowns  0^2,  and  W3.  To  solve 
these  equations  an  additional  choice  of  one  of  the  w’s  is  required.  Thus,  in  this 
configuration  the  system  becomes  a two  degree-of-freedom  system. 

For  the  case  of  seven  screws,  representing  a 7R  closed  loop  mechanism,  the  system 
is  said  to  be  in  an  uncertainty  configuration  if  all  the  determinants  of  the  7x6  matrix, 
given  by  Equation  (4.7),  vanish  simultaneously.  It  is  not  possible  to  solve  the  screw 


equation. 
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— 


(4.9) 


for  the  six  joint  angular  velocities,  and  the  end-effector  will  hesitate  or  stop.  Equation 
(4.9)  can  be  expressed  as  a set  of  five  non-homogeneous  equations  in  five  joint  velocities, 
for  instance  Wj,  ^2,  W5  and  there  is  a free  choice  for  the  velocity  Wg. 

Hunt  [1978]  classified  uncertainty  configurations  according  to  the  rank  of  the  7x6 
matrix  (Equation  (4.7)),  and  a j-fold  uncertainty  configuration  occurs  when  the  rank  of  J 
is  (6— j).  Whilst  the  explanation  of  some  uncertainty  configurations  is  simple,  others  are 
more  difficult  to  explain. 

4.2  Special  Configuration  of  Multi-Fingered  Hands 
The  analysis  presented  in  Chapter  3 will  fail  when  the  matrices  J and/or  K 
become  singular.  The  matrix  K is  singular  when  one  or  more  of  the  fingers  is  in  special 
configuration.  The  matrix  J is  singular  when  the  contact  wrenches  do  not  span  a six 
space  and  the  object  being  grasped  is  not  fully  constrained  by  the  fingers.  These  are  a 
total  of  four  cases  which  must  be  considered: 

4.2.1  Case  1:  The  matrix  K is  not  fully  ranked 

Consider  that  the  rank  p of  K is  less  than  9 (p<9).  The  reverse  solution,  using 
the  SVD  of  K yields: 


n = -t-  V2Y 


(4.10) 


together  with 


0 = 


(4.11) 


K'^  = VBU"^ 


where 


(4.12) 
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Uj  is  a 9xp  orthogonal  matrix  (4.13) 

U2  is  a 9x(9  — p)  orthogonal  matrix  (4.14) 

These  two  equations  are  very  important  because  they  describe  the  kinematics  of 
the  fingers  when  singularities  occur. 

In  Equation  (4.11),  JU2  is  a 6x(9  — p)  dual  matrix  of  the  constrained  wrenches  and 
which  is  reciprocal  to  £.  The  rank  of  JU2  is  thus  a measure  of  the  dgrees  of  freedom  lost 
by  the  object. 

This  case  is  equivalent  to  the  uncertainty  configuration  for  serial  manipulators. 
Because  the  number  of  equations  in  the  nine  is  less  than  nine,  one  or  more  of  these 

parameters  have  to  be  chosen  arbitrary. 

Example  4.1 

An  example  of  this  case  is  given  by  Figure  4.4  which  illustrates  a two  fingered 
hand  grasping  an  object.  Each  finger  has  three  joints  which  results  into  six  joint 
velocities  to  be  found. 

The  contact  wrenches  are 

[ -1, 0, 0;  0, 0,  of 

ir^2^  = [ 0,  1,  0;  0,  0,  1]^ 

irT  = [0,  0,  1;0, -1,  Op 

[ 1,  0,  0;  0,  0,  0]^ 

$!?  = [ 0,  -1,  0;  0,  0,  1^ 

l!?  = [ 0,  0,  1;  0,  1,  0]'' 
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Figure  4.4 
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and  the  screws  representing  the  joints  are 


= [ 1,  0,  0;  0,  0,  0]^ 

= [ 0,  1,  0;  0,  0,  3]^ 

= [ 0,  1,  0;  0,  0,  2p 

= ( 1,  0,  0;  0,  0,  O]”^ 
= [ 0,  1,  0;  0,  0,  -3^ 
= [ 0,  1,  0;  0,  0,  -2]’^ 


The  matrix  K is  given  by  Equation  (3.4)  and  (3.5)  and  is  rewritten  here  as 


K = 


O 


O K 


(2) 


(4.15) 


where 

0 0 0 

0 0 0 

0 0 0 

0 0 0 

0 2 1 

0 -2  -1 

(4.16) 


The  SVD  of  the  matrix  K yields  (see  Appendix  A) 


Q = + V2Y 

(4.17) 

0 = Ujj'^AS 

(4.18) 
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JU2  = 


-1  0 

0 -1 

0 0 

0 0 

0 0 

0 -1 


1 0 

0 1 

0 0 

0 0 

0 0 

0 -1 


The  column  of  the  matrix  JU2  represent  the  screws  that  cannot  be  generated  by  this 
grasp.  The  first  and  third  columns  represent  the  same  screw  which  is  a force  along  the  x 
axis.  The  second  and  fourth  columns  are  two  forces  passing  through  each  contact  point. 
In  this  case  the  singular  grasp  is  unable  to  generate  any  rotation  around  the  Y-axis. 

Since  the  joints  are  pure  rotors  (as  opposed  to  general  screws)  this  condition  implies  that 
the  fingers  are  in  local  or  global  extreme  positions  (see  Sugimoto  & Duffy  [1981]  and 
Waldron  [1981]).  By  extreme  positions  it  is  meant  that  the  fingers  are  fully  extended  (see 
Figure  4.4)  or  fully  retracted,  and  in  either  case  the  tip  of  each  finger  lays  on  the 
boundary  of  its  workspace. 

Since  this  mechanism  is  a hybrid  one,  meaning  that  it  is  partially  serial  (each 
finger)  and  partially  parallel  mechanism  (three  fingers  acting  in  parallel),  some  cases 
might  occur  which  lead  to  some  uncontrollable  motions  similar  to  the  ones  due  to  the 
“Singular  Grasp”. 

4.2.2  Case  2:  The  matrix  K is  equal  to  zero 
Equation  (3.2)  reduces  to 


J'^AS  = 0 


(4.19) 
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When  the  rank  of  the  matrix  J is  equal  to  six,  the  screw  representing  the 
motion  of  the  object  is  reciprocal  to  all  possible  wrenches  in  space.  Therefore,  the  motion 
of  the  grasped  object  is  not  possible  and  this  result  is  independent  of  Q. 

Figure  4.5  shows  an  example  when  the  matrix  J has  rank  less  than  six,  the 
grcisped  object  will  have  (6  — r)  freedoms  which  are  uncontrollable  (a  rotation  around  the 
axis  of  the  two  points  of  contact,  in  the  case  illustrated  by  the  figure). 

The  case  when  K is  equal  to  zero  is  similar  to  the  case  mentioned  before  of 
immovable  structures  for  the  serial  manipulators,  which  is  of  little  interest  since  it  occurs 
only  under  very  special  circumstances  (see  Figure  4.4). 

4.2.3  Case  3:  The  rank  of  the  matrix  J is  less  than  6 

Consider  that  the  rank  r of  J is  less  than  6 (r<6).  Using  the  MSVD  of  J given  in 
Appendix  B and  solving  for  the  contact  intensities  yields 


c = ViBi^U[AW  + Vjo  (4.20) 

together  with 

0 = uJAW  (4.21) 


where 

is  a 6xp  (p<r)  dual  matrix  of  wrenches 
U2  is  a 6x(6-p)  dual  matrix  of  wrenches  and  rank(U2)  = 6 — r 

These  pair  of  equations  are  important  because  they  describe  the  status  of  grasping 


when  the  object  is  not  fully  constrained  by  the  fingers. 
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In  Equation  (4.19)  is  a dual  matrix  of  wrenches  which  can  be  generated  by 
the  “Singular  Gra.sp”. 

In  Equation  (4.20)  U2  is  a dual  matrix  of  twists  which  cannot  be  restrained  by  the 
singular  grasp  and  which  are  reciprocal  to  W.  The  rank  of  U2  is  thus  a measure  of  the 
relative  freedom  between  the  hand  and  the  object. 

Notice  that  the  grasped  object  gains  more  freedom  when  J becomes  singular,  and 
the  unrestrained  motion  is  given  by  the  matrix  U2,  which  is  generated  by  the  MSVD  of  J. 
On  the  other  hand,  it  loses  some  of  its  freedom  when  the  matrix  K goes  singular,  and  the 
additional  constraints  are  given  by  the  matrix  JU2,  where  U2  is  given  by  the  SVD  of  the 
matrix  K.  This  fact  shows  the  duality  between  parallel  and  serial  mechanisms. 


Example  4.2 

When  a pair  of  fingers  grasp  an  object  with  point  contact  the  screws  representing 
the  contact  wrenches  are  given  in  Example  4.1.  The  matrix  J is 


-10  0 10  0 

0 10  0 10 


J = 


0 

0 


0 

0 


1 

0 


0 

0 


0 

0 


1 

0 


0 0 -1  0 0 1 


0 10  0 10 


and  the  MSVD  of  J given  by  Appendix  B yields 
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U2 


0 

0 

0 

1 

0 

0 


the  columns  of  U2  represent  the  twists  that  cannot  be  restrained  by  the  grasp.  In  this 
example  the  rank  of  U2  is  equal  to  one  and  its  column  represents  the  twist  around  the 
line  of  the  two  contacting  points  (see  Figure  4.4). 

Due  to  the  nature  of  the  operator  A,  the  rank  of  the  matrix  J (five  in  this  case)  is 
different  from  the  rank  of  the  matrix  J^AJ  (four  in  this  case).  In  case  of  singularity  the 
rank  of  the  matrix  J is  equal  to  the  degrees  of  freedom  of  the  grasped  object. 

For  point  contact  with  friction  there  are  three  cases  of  singularities  which  depend 
on  the  number  of  fingers  n.  Equation  (B-43),  rewritten  here  as 


0 = DET(n(R2  + . . . + r2)  _ (r^  + . . . + r^)2  + (4  22) 

yields  always  three  pairs  of  ±Aj’s  which  are  the  modified  singular  values  of  the  matrix  J. 


Let 

^ = n(R^  + •••  + Rn)  — (R-i  + ■■■  + Rn)^ 


(4.23) 


a 3x3  matrix,  three  cases  can  be  cosidered  for  different  values  of  n: 
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• n=l,  only  one  finger  is  contacting  the  object  and  the  matrix  ^ = 0.  As  we  will 
show  later  the  contact  intensities  required  to  counteract  a properly  placed  external  force 
are  independant  of  the  A’s.  Therefore,  the  object  can  still  be  able  to  withstand  external 
forces  applied  at  the  point  contact.  But  due  to  the  nature  of  the  contact,  a force  pulling 
the  object  away  from  the  fingertip  will  cause  the  contact  to  break.  Thus,  the  point 
contact  with  friction  can  be  modeled  cis  a spherical  joint  as  long  as  the  conditions  given 
by  Equation  (3.37)  are  satisfied.  Clearly,  an  object  contacted  by  only  one  finger  cannot 
withstand  any  external  wrench,  except  under  very  special  cases.  A force  pushing  the 
object  straight  against  the  fingertip  (see  Figure  4.5),  could  be  resisted  by  only  one  finger. 
However,  this  contact  is  clearly  unstable. 

• n=2,  this  case  is  given  by  Example  4.1.  The  pair  of  eigenvalues  ±Aj 
corresponding  to  the  axis  joining  the  two  contact  points  is  zero.  From  Equation  (3.25) 
we  can  conclude  that  a couple  around  the  same  axis  yields  an  infinite  contact  intensities. 
This  is  the  only  singularity  that  could  occur  to  the  grasp. 

• n>3,  the  matrix  ^ is  always  non  singular  provided  that  the  contact  points  are 
not  colinear.  The  object  is  fully  constrained  by  the  contacting  fingertips. 

Another  way  to  classify  these  singularities  is  by  examining  the  matrix  U given  by 
Equation  (B-47) 


V.2 


U=p 


^z 


(4.24) 
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Figure  4.5 
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Three  cases  can  be  identified  according  to  the  values  of  the  bj’s: 

• All  the  bj’s  are  different  from  zero.  In  this  case  the  matrix  U is  non  singular 
and  hence  the  grasp  is  non  singular.  Three  or  more  fingers  are  required  to  achieve  this 
kind  of  grasp. 

• One  of  the  bj’s,  for  instance  b^,  is  equal  to  zero.  The  matrix  U is  singular  and 
can  be  split  in  two  matrices  and  U2  as  follows: 


U = [Uil  U2] 

where 


Ui 


Ul  V2  -3 

Rui  Ru2  + b2i!2  Ru2~^2-2 


(4.25) 


(4.26) 


Rui 


(4.27) 


U2  contains  only  one  screw,  which  is  a rotation  around  the  axis  joining  the  two 
contacting  points  (see  Example  4.2). 

• Two  of  the  bj’s,  for  instance  bj^  and  b2,  are  zero.  The  matrix  U can  be  split  in 
two  matrices  and  U2 

U = [Uil  U2]  (4.28) 


where 
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1^1 

V2 

Ru2 

RUj  + bgUg 

R^-b3ti3 

(4.29) 


RI!i  R-1J2 


(4.30) 


In  this  case  two  rotations  are  uncontrollable.  The  axes  of  these  rotations  are 


R-Hi 


^2 


H2 

Rij2 


(4.31) 


This  kind  of  grasp  is  impossible  to  realize  using  only  point  contact  with  friction.  This 
ca.se  is  a good  representation  of  a universal  joint  where  two  rotations  around  two 
perpendicular  axes  are  allowed. 

• All  the  three  bj’s  are  zero.  The  matrix  U is  again  decomposed  in  identical 
matrices  and  U2 


= [Uil 

U2] 

V2 

Rijl 

Ru2 

Kv- 

(4.32) 


(4.33) 


In  this  case  the  three  rotations  are  uncontrollable.  This  kind  of  grasp  occurs  when  only 


one  finger  is  contacting  the  object.  The  three  screws  in  the  matrix  represent  three 
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forces  that  can  be  transmitted  through  the  contact.  Also  this  matrix  U can  represent  a 
spherical  joint. 

4.2.4  Case  4:  J and  K are  Singular 

Under  these  conditions  the  object  has  simultaneously  some  unattainable  motions, 
defined  by  case  1,  and  some  unrestrained  ones,  defined  by  case  3. 

In  the  following  section  we  will  only  consider  the  case  where  n = 3,  which  allows  a 
total  control  of  the  motion  of  the  object  in  order  to  manipulate  it  properly. 


CHAPTER  5 
OPTIMAL  GRASP 


Several  attempts  were  made  to  define  an  optimal  grasp  (Li  & Sastry  [1985],  Kerr 
[1985])  and  various  criteria  were  proposed.  Kerr  used  the  singular  values  of  the  matrix  J 
and  decided  that  the  best  direction  corresponds  to  the  smallest  one.  But  the  singular 
value  decomposition  and  the  singular  values  are  not  invariant  with  a change  of  origin  as 
noticed  by  Lipkin  and  Duffy  [1985]  and  thus  they  are  denied  any  physical  meaning.  Li  & 
Sastry  were  aware  of  this  problem  and  based  their  criteria  on  the  task  to  be  executed  by 
the  object.  In  this  chapter  the  modified  singular  value  decomposition,  introduced  in 
Appendix  B,  is  used  to  generate  the  criteria  needed  for  this  optimization. 

The  problem  of  optimization  can  be  stated  as  follows: 

• Minimize  Q (the  joint  angular  velocities)  or  c ( the  contact  intensities) 

• Subject  to  a unit  twist  IJ,  of  the  object  or  a unit  wrench  U.  applied  to  the  object. 

In  this  formulation  another  problem  arises  which  deals  with  the  definition  of  a 

unit  twist  or  wrench.  In  the  next  section  a definition  of  a unit  screw  is  presented  based 
on  the  virtual  power. 

5.1  Unit  Screws 

In  the  following  sections  a novel  analysis  is  proposed  to  optimize  the  motion  of  the 
grasped  object.  By  this  it  is  meant  that  it  is  required  to  minimize  the  instantaneous  joint 
motions  (or  dually  contact  intensities)  for  a grasped  object  subjected  to  a unit  twist  (or 
dually  a unit  wrench). 
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Let  the  block  in  Figure  5.1  be  moving  along  the  direction  represented  by  the  unit 
vector  u.  A force  F is  applied  to  the  block  which  causes  the  motion  along  u,  and  we  have 


F = Au 

(5.1) 

V = t;u 

(5.2) 

where  v is  the  velocity  of  the  block.  The  resultant  virtual  power  is 


P = F^v  = Auu^u 

(5.3) 

II 

(5.4) 

Therefore,  for  a unit  force  (A  = l)  and  a unit  velocity  (u  = l)  the  resultant  virtual 
power  is  unity. 

Analogously,  for  a body  moving  along  a screw  ^ in  space  with  a twist  T = wS  and 
subject  to  a wrench  W = (see  Figure  5.2),  the  virtual  power  P is  (see  Ball  [188?] 

P = W'^AT  = fwi'^Ai  (5.5) 

For  a unit  force  (f=l)  and  a unit  twist  (w  = l)  the  virtual  power  has  to  be  unity,  thus 

= 1 (5.6) 

is  the  required  condition  for  a screw  to  be  a unit. 

Before  proceeding  with  this  analysis  it  is  necessary  to  define  what  is  meant  by  a 
unit  screw.  This  is  not  a trivial  problem  because  associated  with  a twist  (wrench)  are  the 
magnitudes  of  angular  and  translational  velocities  (force  and  couple). 
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V 


Figure  5.2 
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Kerr  [1984]  defined  the  magnitude  by 


(5.7) 


This  definition  involves  the  orthogonal  product  of  screws  which  has  been  shown  to  be  non 
invariant  and  is  therefore  meaningless  (Lipkin  Duffy  [1984]). 

Here  we  propose,  using  Equations  (5.4)  and  (5.5), 


As  the  pitch  of  a screw  approaches  zero  or  infinity,  it  is  easy  to  see  that  there  is  a 
discontinuity  in  the  assessment  of  the  mag(^),  but  in  the  event  this  does  not  affect  the 
usefulness  of  this  definition  in  the  application  described  below. 

It  follows  that  we  can  now  attach  a meaning  to  a unit  screw  IJ  along  any  screw  of 
whatever  pitch,  namely 


(5.8) 


as  the  magnitude  of  a screw.  We  accept  that  may  be  zero  (i.e.  when  the  screw  is  a 


line)  or  the  pitch  is  infinite.  In  such  instances  we  need  to  make  respectively 


mag($)  = IlSi 


(5.9) 


and  mag($)  = |Sn| 


(5.10) 


respectively,  these  two  agreeing  with  common  earlier  usage  mentioned  by  Lipkin  [1985]. 


(5.11) 
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Let  a body  be  constrained  by  a given  unit  screw  JJ  and  having  a twist  T = wlj. 
about  it,  where  w = mag(T).  Let  there  be  a wrench  of  the  same  pitch  applied  coaxially 
with  U.;  analogously  W = fli  where  f=mag(W).  The  virtual  power  of  the  wrench  W 
acting  on  the  rigid  body  moving  along  the  twist  T can  be  computed  by  (see  Equation 
(5.5)) 

P =|w'^AT|  = w|il'^Aill=W  mag(iJ)  = W = mag(W)mag(T)  (5.12) 

In  the  degenerate  case  the  screw  iJ  is  reciprocal  to  itself  and  P=0.  In  this  case, 
for  the  virtual  power  to  be  non-zero  the  wrench  and  the  twist  must  be  of  different  types; 
viz.  when  the  wrench  is  on  a line  vector  (force)  then  the  twist  has  to  be  on  a free  vector 
(translation)  and  vice  versa. 

5.2  Optimum  Grasp 

Having  cissigned  a meaning  to  a unit  screw  it  is  now  possible  to  propose  a 
formulation  for  the  optimization  of  the  motion  of  a grasped  object.  The  problem  can  be 
stated  as  follows: 

• Minimize  (fi) 

• Subject  to  a unit  twist  of  the  object 

In  other  words  it  is  requested  to  determine  the  unit  twist  representing  the 
direction  of  motion  of  the  grasped  object  which  is  produced  by  the  minimum  set  of  joint 
angular  velocities.  It  is  interesting  to  note  that  a unit  wrench  on  the  same  screw  requires 
the  maximum  set  of  joint  torques  to  sustain  it. 

Dually,  it  is  required  to  determine  a unit  wrench  on  the  grasped  object  which 
requires  the  minimum  set  of  joint  torques.  It  is  interesting  to  note  that  motion  on  this 
screw  will  generate  the  maximum  set  of  joint  velocities. 
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Consider  that  the  motion  of  the  grasped  object  is  specified  by  a unit  screw 
iJ(  = [u,,UQ]'^).  In  the  caae  of  three  fingers  gr^lsping  an  object  with  point  contacts,  the 
matrix  K is  square  and  it  can  be  inverted,  and  solving  for  Q Equation  (3.2)  yields, 


n = (5.13) 

where  = K’^J. 

Since  is  a non-square  matrix  it  is  necessary  to  employ  the  modified  SVD  which 
has  been  derived  in  detail  in  Appendix  B and  which  is  expressed  as  J^  = UVj . Therefore, 

n = ViU'^Ai  (5.14) 


where  (see  Appendix  B)  V is  a unit  matrix. 


V = [VilV2]  = [Vi-Ve|Y7  VgYg] 


and  U is  a dual  matrix. 


(5.15) 


U = [Ui  - Ye] 


(5.16) 


The  set  of  dual  vectors  {Yj}  form  a ’’co-reciprocal  basis”  for  all  possible  motions  and. 


where 


Y,^AYj  = bij 


(5.17) 
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bjj  = bj  when  i=j 

bjj  = 0 when 


Let  ^ = 


such  that  the  screw  ^ is  a unit  screw 


(5.18) 

(5.19) 


(5.20) 


Taking  $ along  one  of  the  Jij  in  Equation  (5.14)  yields  a simple  expression  for  the 
joint  rotations 


0.  = ±Yj^|  for  i = ilj 


(5.21) 


inl  = |Vil^lh|  = = gi 


(5.22) 


and  the  minimium  magnitude  is 


min(Q)  = min(g:)  = g 


(5.23) 


In  summary,  a twist  on  ^ corresponding  to  the  minimum  of  gj  yields 
which  constitutes  the  most  sensitive  twist  of  the  object.  On  the  other  hand,  a wrench  on 
the  same  screw  U,  yields  |r|  = Lr,  ( max(||r|)=  — — r = 1 1.  Therefore,  the  same 


screw  IJj  represents  also  the  wrench  which  requires  the  maximum  set  of  joint  torques  to 


sustain  it. 
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This  procedure  can  also  be  used  to  yield  a quality  measure  to  evaluate  a grasp.  Li 
&:  Scistry  [1986]  and  Kerr  [1984]  proposed  the  use  of  the  singular  values  of  similar 
matrices  to  to  evaluate  the  grasp.  But  the  authors  of  Li  Sastry  [1986]  noticed  that 
this  criterion  is  not  invariant  with  a change  of  origin  and  recommended  that  it  should  be 
avoided.  This  problem  has  been  solved  here  by  using  the  modified  singular  value 
decomposition  (MSVD)  and  the  modified  singular  values  bj  as  a criterion  to  choose 
between  different  grasps. 

A choice  of  a grasp  with  a higher  value  of  g yields  a higher  value  of  and  a 

lower  value  of  lillmax-  Therefore,  a compromize  can  be  made  in  this  case  between 
sensitivity  and  strength  of  the  grasp.  For  instance,  if  it  is  required  to  produce  an 
accurate  infinitesimal  motion  of  the  workpiece  on  some  specified  screw  then  high 
sensitivity  (high  g)  is  needed.  This  grcisp  will  also  yield  low  minimum  joint  torques  and 
therefore  the  strength  of  the  grasp  is  low. 

On  the  other  hand  if  it  is  required  to  move  a heavy  object  for  which  contact  forces 
are  high  (low  g)  then  accurate  manipulation  may  not  be  possible.  This  is  clearly  a 
problem  of  point  contact  with  friction  where  normal  pressures  will  be  high  due  to  the 
small  contact  areeis.  This  problem  is  now  discussed  in  some  details. 

5.3  Grasping  with  Point  Contact  with  Friction 

When  an  object  is  subjected  to  a high  pressure,  permanent  deformations,  or  even 
destruction  of  the  object,  can  take  place  during  the  grasping  process.  Further,  when  the 
grcLsped  object  bears  a load,  it  may  be  distributed  among  all  the  fingertips.  Hence,  the 
efficiency  of  exerting  a load  on  the  object  depends  on  the  way  it  is  grasped. 

Consider  the  expression  for  the  manipulating  contact  wrench  intensities  given  by 
Equation  (3.25)  and  also  Appendix  B 
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cn,  = ViBi^U'^AW 


(5.24) 


where  W is  an  external  wrench  acting  upon  the  grasped  object. 

The  MSVD  of  three  point  contacts  with  friction  is  given  in  detail  in  Appendix  B. 
This  analysis  essentially  reduces  to  determining  the  eigenvalues  ±bj’s  and  the 
corresponding  eigenvectors  li’s  of  the  matrix 


= 3(Rf  +R|  +rI  ) - (Ri  + R2  + R3)" 


(5.25) 


where 


Ri  = 


0 

-Z; 


Zi  -Yi 

0 Xj 

-X:  0 


= IljX],  for  i = l,  2,  3 


(5.26) 


and  Tj  are  vectors  drawn  from  an  origin  O to  the  three  contact  points  respectively. 
Briefly  U is  a 6x6  matrix  of  the  form 


U=p 


Ruj^  + bj^Ul  Rwi  — bj^U]^ 


^2 


M3 


M3 


(5.27) 


where  p and  R are  functions  of  the  number  n of  fingers 


P = 


N2 


(5.28) 
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Ri  + R2  + R'3 

n.  = n 


(5.29) 


for  the  case  of  3 fingers  P = 'y|^  R= 


Consider  firstly  that  the  wrench  is  a unit  force  applied  to  a specified  point  C, 
defined  by  OC  = r=  3,nd  that  is  parallel  to  one  of  the  eigenvectors,  for  example 

Uj.  Therefore, 


W = 


(5.30) 


where  R is  defined  by  Equation  (5.29). 

Substituting  for  W and  U in  (5.24)  using  (5.30)  and  (5.27)  and  simplifying  the 
result  yields,  the  following  form  for  c^ 


3 


3 


0 


Cm  — p V 1 B 


0 


(5.31) 


0 


0 
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Cm 


(V1+Y2) 

3 


(5.32) 


|£m| 


(5.33) 


This  is  a most  important  result.  A unit  force  applied  to  the  special  point  C yields 
a constant  value  of  the  contact  intensities,  [Cml,  which  is  independent  of  the  direction  of 
the  applied  force. 

In  general,  for  a hand  with  n fingers,  the  point  C is  defined  by 


ic 


(5.34) 


and  it  is  called  the  center  of  the  grasp,  and  a force  applied  whose  line  of  action  passes 
through  C is  isotropic. 

The  center  of  the  grasp  is  also  the  centroid  of  the  contact  points  where  all  the 
points  are  weighted  equally.  By  choosing  the  center  of  the  grasp  as  close  as  possible  to 
the  point  of  application  of  the  external  force,  we  can  minimize  the  contact  intensities  at 
the  fingertips  and  have  a constant  value  of  the  intensity  of  [Cml-  Next,  an  analysis  of  the 
contact  intensities,  in  the  caise  of  a pure  couple  as  the  external  wrench,  is  presented. 

Consider  secondly  that  the  wrench  W is  a unit  couple  applied  to  the  object  and  it 
is  along  one  of  the  eigenvectors,  for  example  Therefore, 

(5.35) 

Substituting  for  W and  U in  (5.24)  using  (5.35)  and  (5.27)  and  simplifying  the  result 
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yields, 


1 

1 


Cm  — 


0 

0 


0 

0 


(5.36) 


= P 


(Y1  + V2) 

bi 


(5.37) 


(5.38) 


Equation  (5.38)  shows  that  the  minimum  (maximum)  Jc^l  is  produced  by  a pure  couple 
along  the  eigenvector  ^ corresponding  to  the  maximum  (minimum)  eigenvalue  bj. 

This  result  can  be  interpreted  geometrically  (Asada  et  al.  [1987])  by  an  ellipsoid, 
which  will  be  called  here  the  Grasp  Ellipsoid  (see  Figure  5.3).  The  principal  axes  are  the 
eigenvectors  V2,  and  Vj,  and  the  length  of  each  principal  axis  is  equal  to  the  reciprocal 
of  the  corresponding  eigenvalue.  The  magnitude  of  the  Cm  will  depend  on  the  direction  of 
W since  the  smallest  (largest)  eigenvalue  corresponds  to  the  major  (minor)  axis  of  the 
ellipsoid.  The  maximum  (minimum)  of  [Cm|  is  due  to  a unit  couple  acting  around  the 
major  (minor)  axis  of  the  ellipsoid.  Therefore,  a unit  couple  around  the  minor  axis  yields 
the  minimum  magnitude  of  the  vector  Cm. 
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Minor  Axis 
Minimum  Contact  Intensities 


Major  Axis 

Maximum  Coatacl  Intensities 


Figure  5.3:  Grasp  Ellipsoid 
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Example  5.1 


Let  the  object  shown  in  Figure  5.4  be  grEisped  by  three  fingers.  The  matrix  J in 
this  case  is  given  by 


1 


= 


0 


0 


To  = 


-.707 

.707 

0 


£3 


0 

-1 

0 


The  modified  singular  values  of  the  matrix  J are  given  by  Equation  (B-43) 


DET^3(Rf  +Ri  +R§  ) - (Ri  + Rs  + R3)^  + a2i3^=0 


DET 


4.4 

1.4 

0 

1 

0 

0 

1.4 

4.4 

0 

- a2 

0 

1 

0 

0 

0 

8.8 

0 

0 

1 

= 0 
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Figure  5.4 


Figure  5.5 
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which  yields 


bj^  2 — — ±1.73 

b3  4 = ±A2  = ±2.41 
bg  g = ±A3  = ±2.97 

and  the  corresponding  eigenvectors 


ii3 


.707 

.707 

0 

.707 

-.707 

0 

0 

0 

1 


The  grasp  ellipsoid  is  shown  in  Figure  5.3.  This  analysis  shows  that  a couple  around  the 
z-axis  yields  the  minimum  contact  intensities  at  the  fingertips.  Therefore,  this  grasp  is 
more  efficient  when  the  external  wrench  on  the  object  can  be  reduced  to  a couple  around 
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the  z-axis.  This  also  shows  that  this  is  the  best  way  to  grasp  a nut  mounted  on  a screw 
along  the  z-axis. 

Let  the  same  object  grcisped  a.s  shown  in  Figure  5.5,  where  the  contact  points  are 
now  located  in  1^,  2'  and  3^ 


1 


0 


0 


0 


0 


0 


and  the  modified  singular  values  are  given  by  Equation  (B-43) 
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which  yields 


bj^  2 = ~ ±1.41 

bj  4 = ±A2  = ±2.45 
bg  g = ±Ag  = ±2.83 

and  the  corresponding  eigenvectors 


1^1 


1 

0 

0 


0 

1 

0 


0 


^3  = 


0 


1 


Here  again  the  z-axis  is  best  axis  to  apply  a couple  to  the  grasped  object. 

Comparing  the  two  grasps  yields  that  the  contact  forces  at  the  fingertips  of  the 
first  grasp  for  which  min(|bj|)  = 1.73  are  less  than  those  for  the  second  grasp  for  which 
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the  min(|bj|)  = 1.41.  Further,  since  the  grasp,  ellipsoid  for  the  first  grasp  is  smaller  than 
the  one  for  the  second  grasp,  it  yields  smaller  contact  intensities  overall. 

Considering  a different  gretsp,  where  the  number  of  fingers  is  greater  than  three, 
say  four,  and  not  all  the  contacting  points  are  on  the  same  plane. 

1 

= 0 

0 

0 

0 

0 

V=  -1 
0 


0 

0 

1 


The  modified  singular  values  are  given  by  Equation  (B-43) 


DET^4(r'/2  + + R^'2  + r”2 


) - (R”  + R'^  + R'-^  + R'^y  + \\'^  = 0 
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DET 


12 

1 

0 

-1 

10 

0 

- A2 

0 

0 

8 

0 0 
1 0 
0 1 


which  yields 

bj  2 = ~ ±2.45 

bj  4 = ±A2  = ±3.16 
bg  g = ±Ag  — ±3.46 

and  the  corresponding  eigenvectors 


0 


1 


0 


0.707 


V2  = 


0 


0.707 


-0.707 


^3 


0 


0.707 
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5.4  General  Criterion 

A general  criterion  to  chose  between  grasps  can  be  defined  as  follows 


(5.39) 


where  n is  the  number  of  fingers.  Since  the  bj’s  come  in  pairs,  the  definition  of  77  can  be 
simplified  to  yield 


n = 


bi  + ba  + bg 

n 


(5.40) 


This  criterion  represents  the  efficiency  of  the  grasp.  A grasp  with  higher  tj  is  more 
efficient  in  resisting  the  external  wrench  applied  to  the  grasped  object.  Moreover,  this 
criterion  allows  the  comparison  of  grasps  with  different  numbers  of  fingers.  The  following 
example  can  best  demonstrate  the  usefulness  of  this  criterion. 

Example  5.2 

Using  the  same  cases  mentioned  in  the  above  example,  we  get 

• for  case  1 shown  in  Figure  5.4,  where  n=3 

bj  = 1.73 

ba  = 2.41  I Vi  = 2.37 

bg  = 2.97 

• for  case  2,  shown  in  Figure  5.5,  where  n=3 

bi  = 1.41 
ba  = 2.45 
bg  = 2.83 


t]2  = 2.23 
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• Four  finger,  Figure  5.6 
bi  = 2.45 

63  = 3.16  1^/3  = 2.26 

65  = 3.46 


Clearly,  case  1 yields  the  most  efficient  grasp  since  it  has  the  highest  77.  It  is 
interesting  to  note  that,  for  case  3,  increasing  the  number  of  fingers  did  not  produce  a 
more  efficient  grasp. 

Other  cases  can  be  mentioned  which  will  show  that  the  number  of  fingers  is  not 
the  best  way  to  improve  the  quality  of  the  grasp;  but  it  is  the  way  the  fingers  are  placed 
around  the  object  that  makes  the  grasp  more  efficient. 

• Four  fingers.  Figure  5.7, 

b^  = 2.83 
b3  = 2.83 
bg  = 4.00 

• Five  fingers.  Figure  5.8, 

bi  = 3.74 
b3  = 3.74 
bg  = 4.47 

The  last  two  examples  are  “equivalent”  in  the  sense  that  they  have  the  same  set 
of  bj’s.  However,  these  two  grasps  differ  in  the  optimum  directions,  which  can  be  shown 
by  looking  at  the  two  corresponding  grasp  ellipsoids;  the  first  one  has  the  y-axis  and  the 


774  = 2.41 


775  = 2.39 
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Figure  5.6 


Figure  5.7 


Figure  5.8 
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z-axis  as  major  and  minor  axes  respectively,  while  the  second  has  the  y-axis  and  the  x- 
axis  as  major  and  minor  axes  respectively. 

Figure  5.9  summarizes  the  above  results.  It  is  important  to  recognize  that 
increasing  the  number  of  fingers  does  not  necessarely  improve  the  efficiency  of  the  grasp. 
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Figure  5.9 


CHAPTER  6 

PATH  GENERATION  AND  COMPUTER  GRAPHICS  SIMULATION 


6.1  Introduction 

In  the  process  of  design,  computer  graphics  simulation  is  a very  important  and 
rewarding  step.  This  chapter  is  concerned  with  the  design  and  animation  of  a mechanical 
hand  model.  Two  main  objectives  are  sought  in  a computer  graphics  simulation 

• the  diplay  of  different  designs  displayed  via  solid  3-D  models, 

• the  display  of  each  individual  design  executing  a variety  of  tasks. 

The  comparison  and  evaluation  of  the  graphics  model  enables  us  to  choose  the 
best  design  from  a number  of  alternatives.  This  last  concept  was  presented  by  Crane 
[1987]  and  was  applied  to  robot  manipulators. 

In  this  chapter  we  will  be  more  concerned  with  the  second  aspect  of  this  problem, 
namely  path  planning.  The  calculation  of  a series  of  joint  angles  for  each  finger  which 
will  cause  the  grasped  object  to  move  along  a user  specified  path,  is  presented  here. 
These  calculations  will  serve  as  input  to  the  hand  animation  program,  also  presented  in 
this  chapter.  In  this  manner,  the  user  will  be  able  to  observe  and  evaluate  the  hand- 
object  motion  on  the  graphics  screen.  The  model  used  for  this  demonstration  is  presented 
in  section  6.2.2. 

The  first  problem  to  be  considered  will  be  the  location  of  the  palm  with  respect  to 
the  object,  which  allows  for  the  grasp  and  the  manipulation  of  the  object.  The  problem 
of  path  generation  is  then  reduced  to  the  selection  of  intermediate  object  positions  and 
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orientations  between  the  start  and  target  positions.  A reverse  kinematic  analysis  is  then 
performed  for  each  finger  for  each  of  these  locations. 

6.2  Kinematic  and  Force  Analysis  of  the  Hand 

6.2.1  Notation 

Each  finger  may  be  considered  eis  a set  of  rigid  bodies  connected  in  a chain  by 
joints.  These  bodies  are  called  links.  Many  manipulators  have  sliding  joints  called 
prismatic  joints.  A single  link  of  a typical  robot  (a  robot  is  referred  to  as  a finger  in  this 
chapter)  has  many  attributes  which  a mechanical  designer  has  to  consider  during  its 
design.  These  include  the  type  of  material  used,  the  strength  and  stiffness  of  the  link,  the 
external  shape,  the  weight  and  inertia,  etc.  However,  for  the  purposes  of  obtaining  the 
kinematic  equations  of  the  finger,  a link  is  considered  only  eis  a rigid  body  which  defines 
the  relationship  between  two  neighboring  joint  axes  of  a finger.  The  notation  used 
throughout  this  analysis  is  that  developed  by  Duffy  [1980].  One  link,  as  the  one  shown  in 
Figure  6.1,  connects  the  two  joint  axes  Sj  Sj-  The  perpendicular  distance  berween 
them  is  well  defined  and  is  referred  to  as  ay  and  lies  along  the  mutual  perpendicular  ay. 
The  second  parameter  needed  to  define  the  relative  location,  is  the  twist  angle  Oy.  This 
angle  is  measured  in  a right  handed  sense  about  the  vector 

Neighboring  links  have  a common  joint  axis  between  them.  Figure  6.2  shows  two 
links  connected  by  a revolute  joint.  One  parameter  of  interconnection  has  to  do  with  the 
distance  along  this  common  axis  from  one  link  to  the  next  and  is  referred  to  as  Sjj.  The 
second  parameter  describes  the  amount  of  rotation  about  this  common  axis  between  one 
link  and  its  neighbor.  This  parameter  is  called  the  joint  angle,  and  is  referred  to  as  0j. 

Of  the  parameters  joint  angles  (0j),  twist  angles  (oy),  offsets  (Sjj),  and  link  lengths 
(ay),  only  (0j)  is  a variable  quantity  while  the  remaining  three  are  known  constant  values. 


89 


Figure  6.1 
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Figure  6.2 


91 


Using  Figure  6.1  and  Figure  6.2  it  is  possible  to  derive  the  following  equations  for  the  sine 


and  cosine  of  Oy  and  9-^ 

cos(Qjj)  = cy  = (6.1) 

sin(Qy)  = sy  = |Sj  Sj  ay|  (6.2) 

cos(^j)  = Cj  = ajaj^  (6.3) 

sin(^j)  = Sj  = |ay  aj,^  S,j|  (6-4) 


6-2-2  Dimension  of  the  Hand  Model 

A palm  and  three  identical  fingers  are  the  main  components  of  the  hand.  The 
palm  serves  as  a base  for  the  three  fingers.  Shown  in  Figure  6.3^  is  a skeletal  drawing  of 
one  of  these  fingers.  Each  finger  is  essentially  a 3-R  robot  where  the  first  joint  is  vertical, 
the  second  and  third  are  parallel  and  at  right  angles  to  the  first  one.  The  skeletal  model 
of  the  fingers  is  very  similar  to  that  for  the  T3-776,  when  the  wrist  is  excluded  [Crane 
1987]. 

The  following  table  contains  the  values  of  the  constants: 


S22  = 0 

— 0 

a^2  = 90° 

S33  = 0 

a23  = 10.0 

0 

0 

II 

fO 

CM 

S44  = 10.0 

0 

II 

fO 

034  = 90° 

The  vector  a,y  is  defined  cis  the  normal  to  the  plane  defined  by  the  two  vectors  Sj  and  Sj 
and  is  given  by 

1 

For  the  sake  of  simplicity,  all  the  superscripts  (i)  (i=l,  2,  and  3)  are  omitted  from  the 
figures. 
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(6.5) 


In  the  case  where  S.j  is  parallel  to  Sj>  §;jj  is  along  the  common  perpendicular  and  pointing 
from  ^ to  2j- 

6-2-3  Reverse  Analysis 

The  reverse  analysis  of  the  hand  can  be  reduced  to  a reverse  analysis  for  each 
finger.  The  location  of  the  finger  contact  points,  relative  to  the  grasped  object,  are 
assumed  to  be  known.  Following  this,  it  is  necessary  to  determine  the  positions  of  each 
finger  tip  in  the  fixed  coordinate  system.  This  is  accomplished  from  the  knowledge  of  the 
position  and  orientation  of  the  grasped  object,  measured  relative  to  the  fixed  reference. 
Finally,  from  the  location  of  each  fingertip  (see  Figure  6.3)  the  set  of  joint  angles  for 
each  finger,  ^2^,  and  ^3^  are  computed.  Given  all  these  data,  one  can  perform  the 
reverse  analysis  of  each  finger  following  these  steps: 


The  vector  R^'\  where  f refers  to  the  fixed  coordinate  system,  is  given  by  (see 


Figure  6.4) 


+ Aof  I| 


(6.6) 


where 


R^  is  the  vector  pointing  to  origin  of  the  object  in  the  fixed  coordinate  system 
Aq^  is  a rotation  matrix  from  the  local  coordinate  system  of  the  object  to  the  fixed 


r['^  represents  the  local  position  of  the  i^*’  contact  point. 

• Figure  6.5  illustrates  that  the  vectors  R^'\  a^2’  3:23’  and  all  lie  in 

the  same  plane.  Because  of  this,  simple  planar  relationships  can  be  utilized  to  determine 
the  three  relative  displacement  angles  ^2^,  and  ^3^  for  each  finger. 
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Figure  6.4 
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Figure  6.5 
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The  angle  is  defined  as  the' angle  between  the  fixed  x — axis  and  the  vector  a^2 
measured  as  a positive  twist  about  the  vector  The  following  equations  are  used  to 

compute  the  sine  and  cosine  of 


cos((?ii^) 

sin(<Ax^) 


|i 


(6.7) 

(6.8) 


where  the  vector  a^'^  is  given  by 


(i)  (R^‘^'"i)i  +(E}‘^"'i)i 


ai2  — ± 


(6.9) 


With  the  above  convention  for  a,x2  two  values  of  <j)^^  are  given  by  Equations  (6.7) 
and  (6.8).  However,  only  the  value  of  in  the  interval  [ 0,  tt  ] is  considered  in  this 
analysis. 

Two  extra  variables,  02^,  and  are  introduced  (see  Figure  6.5)  in  order  to 

facilitate  the  analysis.  These  angles  are  related  to  the  angles  9^^  and  ^3^  by  the 
following  equations: 


- 90° 

- 90° 


(6.10) 

(6.11) 


Applying  the  cosine  law  to  the  planar  triangle  (see  Figure  6.5)  yields 


(i)2 


:(i)2 


(Oa  _ (a-23  + 84^  — 


I)  2 


2a('^s('^ 

■^^23^44 


(6.12) 
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and  hence  two  values  for  <^3^  viz.  ±<^3^  which  define  two  configurations  commonly 
referred  to  as  “elbow  up”  and  “elbow  down”.  Figure  6.6  shows  a single  finger  contacting 
an  object  in  its  two  configurations.  Because  of  the  finite  size  of  the  grasped  object  either 
of  the  configurations  may  not  be  possible  because  of  the  interference  with  the  object,  and 
there  are  three  possibilities.  Consider  now  that  n^*^  is  the  outer  normal  to  the  contacting 
plane  at  the  point  of  contact 

case  1:  0 for  both  values  of  <^3^  (see  Figure  6.6) 

The  value  with  the  higher  (S  Jl  ) yields  a “better”  grasp.  By  better  grasp  it  is  meant 
that  the  potential  range  of  motion  of  the  grasped  object  is  bigger. 

case  2:  0 for  one  of  the  values  for  (j>^^  (see  Figure  6.7) 

Therefore,  there  is  only  one  grasp  configuration. 

case  3:  0 for  both  values  of  <^3^  (see  Figure  6.8) 

No  real  grasp  configuration  is  possible  is  this  case. 

The  final  step  in  this  analysis  is  the  computation  of  the  joint  angle  ^2^. 
Projection  is  used  to  derive  the  necessary  equations.  It  is  shown  in  Figure  6.5  that  the 
vector  can  be  written  as 


r(i)_  (i)  (i)  , <;(i)  c;(') 

iif  — “•23  -23  ^44  ^ 


(6.13) 


Forming  the  scalar  product  of  (6.13)  with  aj2  and  then  with  and  manipulating  the 
equations,  one  gets  the  following  two  equations  in  c^*^  and  s^'^ 


r(')^  (i)_  0)(  (i)  , (i)  <;(i) 

iif  —12 — ( ^23  — ®2  ^44  ) 


(6.14) 
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Figure  6.6 
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Figure  6.7 


Figure  6.8 
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o(i)_  Ji)  c;(i)  , (i)/'  (i) 

Bf  5.x  — ~^2  ^44  Sin(<p3  ) + §2  ^ ^23  ~ J4^COS{<p^  ) j 


(6.15) 


and  solving  for  and  yields 


[41  - sScos(.?i^‘^))(E}‘^'"  ag)  - S^i  sin(.^^‘^)(R^'^'"  S.^^) 


(0^/o(i)■^  c(')n 


Cj  — 


(i)  2 


(6.16) 


(i)  (^23  ~ S44COs((p3  ) j(R^  ii  ) + S44  Sin((p3  )(R^  &12) 


(')n,o(')^  (i), 


1^' 


(i)  2 


(6.17) 


A unique  value  of  ^2^  can  therefore  be  determined  from  the  above  two  equations. 

The  set  of  joint  angles  required  for  a single  finger  is  now  complete.  For  the  hand 
the  set  of  joint  angles  is  completed  by  adapting  the  above  procedure  to  each  finger,  i=l, 
2,  and  3. 

6-2-4  Forward  Displacement  Analysis  of  the  Hand 

In  the  forward  analysis  the  joint  angles  are  given  and  it  is  necessary  to  find  the 
position  and  orientation  of  the  grasped  object.  This  is  accomplished  by  determining  the 
position  of  each  fingertip  and  the  direction  cosines  of  all  the  5j'^  (j  = 1>  2,  3,  and  4,  and 
i = l,  2,  and  3)  are  needed. 

Figure  6.3  shows  a skeletal  model  of  a finger.  The  coordinate  system  Xj-yj-Zj  is 
defined  such  that  Xj  is  along  3,^2  and  Zj  is  along  The  fixed  coordinate  system  x-y-z 

can  be  obtained  from  the  coordinate  system  Xj-yj-Zj,  which  is  fixed  on  the  i*^^  finger,  by  a 
rotation  of  angle  about  axis  z.  The  corresponding  rotation  matrix  is  in  the 


form 
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M«  = 


cos(03^)  sin(<^j^) 


0 

0 

1 


(6.18) 


The  components  of  the  vector  in  local  coordinates  are  given  by 


a 


23  a,23  + 


q(i)  ;;(i) 

344  i4 


(6.19) 


where 


JXj-yj-Zi 


(6.20) 


®2+3 

0 

'^2+3 


(c2^3  = COs(^2  + ^3)  ®2+3“®*'^(^2^"^3)) 


JXj-yi-Zj 


(6.21) 


(i)  (i)  , 0(0  (i) 

^23*^2  r ^44®2+3 


(6.22) 


J')^(i)  , o(i)  (i) 
a-23''2  T ^44®2+3 


JXi-y:-Z: 
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The  vector 


in  the  fixed  coordinates  is  given  by 


(6.23) 


In  local  coordinates, 


0 

0 

1 


Xj-yj-Zj 


0 

-1 

0 


(6.24) 


(6.25) 


0 

-1 


0 


Xi-yfZi 


(6.26) 


and  the  vector 


is  given  by  Equation  6.20. 


In  the  fixed  coordinates  these  vectors  can 


be  expressed  in  the  form 
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(6.27) 

(6.28) 

(6.29) 

(6.30) 

This  completes  the  forward  analysis  of  the  i**’  finger.  The  same  procedure  is  applied  to 
each  finger  to  yield  the  forward  analysis  of  the  hand. 

6-2-5  Force  Analysis 

Chapter  3 contained  an  extensive  analysis  of  the  contacting  forces.  In  this  section 
we  will  just  show  the  method  of  computation  involved  in  this  process. 

The  characteristic  matrix  equation  is  given  by  Equation  (3.2)  and  rewritten  here 


JTAi=  Kfi 


(6.31) 


where 


J 


(6.32) 


K = 


0 0 0 

0 0 0 

0 0 0 

(M) 


(6.33) 


0 0 0 K 


104 


K^‘>  = 


(6.34) 


4^> 


n = 


(6.35) 


(M) 


0 I, 


A = 


(6.36) 


and  where 


J is  a 6x9 

dual  matrix 

A is  a 6x6 

matrix  given  by  equation  (3.7) 

K is  a 9x9 

matrix 

n is  a 9x1 

vector 

^ is  a 6x1 

dual  vector. 

The  external  wrench  W on  an  object  grasped  by  three  fingers  can  be  expressed  in  the 


following  form: 
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W = ...  + (6.37) 

where  W^'\  wl'^.  wl' ^ are  three  linearly  independent  contact  wrenches  with  intensities 
Cj\  C2*\  and  c^'^  respectively  due  to  the  contact  of  the  i^^  finger.  For  a point  contact 
with  friction  these  contact  wrenches  are  simply  three  forces.  will  denote  the  force 

normal  to  the  plane  of  contact  whilst  and  are  in  the  plane  of  contact. 

However,  for  a soft  contact  the  contact  wrenches  consist  of  three  forces  together  with  a 
couple  which  is  normal  to  the  contact  plane  (see  Salisbury  [1982]).  In  a matrix  form  it 
can  be  written  a.s  follows: 


where 


W = Jc 


c = 


(6.38) 


(6.39) 


and  J is  given  above. 

Solving  Equation  6.37  for  c,  using  the  MSVD  of  J (see  Appendix  B)  yields  the 
following  explicit  expression  for  c 


c = ViB'i^UTAW  + V20 


where 


(6.40) 
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“1 

“2 


“3 


(6.41) 


is  an  arbitrary  vector  which  will  be  determined  using  the  optimization  procedure 
presented  in  section  3.4.3. 

• Determine  the  matrix  J 

Given  the  normal  to  the  contact  surface  at  the  fingertip  n^'\  the  components  of  the 
wrench  can  be  computed  as  follows 


.0) 


(6.42) 


where  is  given  by  Equation  6.22. 

and  are  the  tangential  wrenches.  Let  t^'^  and  t^'^  represent  any  two 

perpendicular  vectors  in  the  plane  of  contact  then 


l2 


(i) 


(6.43) 


I3 

rJ'^x 


t^‘^ 

I3 


(6.44) 
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• Determine  the  matrix  K 


The  screws  , ^2^,  and  are  also  needed. 


o(i) 


Jx=-yi-z= 


^2  — 


JXj-yj-Zj 


«(')_ 
^3  ~ 


41 41 X 4^ 


JXj-yj-Zj 


(6.45) 


(6.46) 


(6.47) 


These  6x1  vectors  can  be  transformed  to  the  fixed  coordinate  system  using  the  following 
6x6  rotation  matrix 


a(‘>  = 


0 


0 M 


(i) 


where  is  given  by  Equation  6.18. 

6.3  Path  Generation 

The  tools  developed  in  the  previous  section  will  be  used  here  to  generate  the 
necessary  information  for  the  hand  to  follow  a prespecified  path.  Given  the  initial  and 
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final  positions,  trajectory  planning  generates  a sequence  of  “control  set  points”  for  the 
control  of  the  hand  from  the  initial  location  to  its  destination. 

Quite  frequently,  there  exists  a number  of  possible  trajectories  between  the  two 
given  end  points.  For  example,  one  may  want  to  move  the  grasped  object  along  a 
straight  line  path  that  connects  the  end-points  (straight  line  trajectory);  or  to  move  the 
grasped  object  along  a smooth  curve  that  satisfies  the  position  and  orientation  constraints 
at  both  ends  (joint  interpolated  trajectory).  In  this  work  we  will  discuss  only  the  straight 
line  trajectory. 

Straight  Line  Trajectory 

It  is  required  to  move  the  grasped  object  along  a straight  line  path  between  two 
known  points  specified  by  Pj  and  in  time  T.  The  initial  and  final  position  and 
orientation  of  the  grasped  object  are  defined  by 


initial 


Pj  = 


y\ 


(6.48) 


ORj  = [ li  Ji  fcj  ] 


(6.49) 
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Pf  = Vf 


(6.50) 


final 


ORf  = [^  if  if  kf 


(6.51) 


The  number  of  intermediate  steps  required  between  the  initial  and  final  states  is 


based  on  the  total  change  of  position  and  orientation.  A stepsize  of  1.0  cm  is  chosen  for 
the  translation,  and  a 5 degree  stepsize  is  chosen  for  the  rotation.  The  number  of 


A detailed  analysis  of  this  procedure  can  be  found  in  Crane  [1987]. 

A computer  program  was  written  to  generate  the  required  joint  angles  at  the 
intermediate  postions.  These  joint  angles  serve  as  input  to  the  graphics  program  so  that 
the  rectilinear  motion  of  the  grasped  object  can  be  viewed  on  the  screen.  The  next 
section  will  describe  this  graphics  software  as  well  as  the  hardware  used  for  the 


intermediate  steps  is  the  greatest  of  the  number  given  by  the  translation  and  the  number 


given  by  the  rotation 


nsteps  max 


animation. 


6.4  Computer  Graphics  Simulation 


The  graphics  animation  was  performed  on  the  Silicon  Graphics  IRIS  4D/70  model 
workstation.  The  most  important  feature  of  this  workstation  is  its  capability  of 
performing  all  the  coordinate  transformation  in  hardware.  A set  of  custom  VLSI  chips 


no 


called  the  Geometry  Engine  are  capable  of  transforming  points,  vectors  and  polygons, 
given  in  world  coordinates,  in  screen  coordinates  at  a rate  of  69,000  3-D  foating  point 
coordinates  per  second. 

To  avoid  flickering,  during  animation,  a double  buffer  animation  technique  is  used. 
This  is  done  by  using  half  of  the  available  IRIS  bitplanes  for  drawing  while  displaying  the 
picture  already  drawn  on  the  other  half  of  the  bitplanes.  A swapbuffers  command  is 
performed,  which  gives  a smooth  animation  free  of  flickering. 

In  drawing  the  hand  model,  two  other  features  of  the  IRIS  where  used,  namely 
backface  polygon  removal  and  the  z-buffer.  The  backface  polygon  removal  algorithm  uses 
the  normal  to  the  surface  to  determine  its  visibility.  If  the  normal  has  a component  along 
the  negative  z-axis  (into  the  screen),  the  surface  is  not  displayed.  The  z-buffer  is  a 
separate  depth  buffer  used  to  store  the  z-coordinate  or  depth  of  every  pixel  in  the  screen 
coordinate  system.  In  use,  the  depth  or  z value  of  a new  pixel  to  be  written  to  the  frame 
buffer  is  compared  to  the  depth  of  that  pixel  already  stored  in  the  z-buffer.  If  the 
comparison  indicates  that  the  new  pixel  is  in  front  of  the  pixel  stored  in  the  frame  buffer, 
then  the  new  pixel  is  written  to  the  frame  buffer  and  the  z-buffer  is  updated  with  the  new 
z value.  If  not,  no  action  is  taken.  The  simplicity  of  the  algorithm  is  its  greatest 
advantage.  Quite  importantly,  it  handles  the  hidden  surfaces  problem  and  the  display  of 
complex  surface  intersections  trivially. 

The  combination  of  these  two  algorithms,  backface  polygon  removal  and  z-buffer, 
leads  to  a very  simple  yet  fast  graphics  programs,  since  most  of  the  sorting  is  done  in  the 
hardware  of  the  machine. 

Figure  6.9  shows  a solid  model  of  the  hand.  Each  finger  has  three  joints,  the  joint 
angle  values  are  displayed  on  the  screen  at  all  times  allowing  the  user  to  check  for  joint 


Ill 


Figure  6.9 


Figure  6.10 
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limits.  Two  modes  of  control  are  available:  manual  mode  and  autonomous  mode. 

In  the  manual  mode,  the  user  can  modify  the  values  of  the  joint  angles  using  the 
mouse  as  input  device,  or  he  can  guide  the  grasped  object  through  a specified  path  using 
the  keyboard.  The  described  path  can  then  be  recorded  and  previewed  by  the  user.  In 
the  autonomous  mode  the  user  is  asked  to  input  the  following  data: 

• location  of  the  object 

• orientation  of  the  object  (OR^ijj) 

• location  of  the  contact  points  in  local  coordinates  (r^'^) 

• normals  at  the  contact  points  (n^'^). 

The  program  computes  the  following  data 

• the  required  joint  angles  for  each  finger  (<^j 

• the  location  of  the  palm, 

and  displays  the  solid  model  of  the  hand  and  the  grasped  object  on  the  screen.  The  user 
can  use  the  mouse  to  change  the  view  point  and  zoom  in  and  out. 

The  second  step  is  path  planning.  The  user  specifies  the  location  and  orientation 
of  the  grasped  object  at  the  initial  and  target  position.  The  program  then  computes  the 
joint  angles  in  the  intermediate  positions  and  the  motion  of  the  grasped  object  is 
previewed  on  the  screen.  This  allows  the  user  to  evaluate  the  performance  of  the  hand  in 
executing  the  specified  tcisk.  Figure  6.10  shows  the  solid  model  of  the  hand  and  the 
grasped  object. 

If  the  user  is  not  satisfied  with  the  generated  path,  he  can  change  it  by  puting  the 
program  in  a teaching  mode.  The  user  can  then  guide  the  object  along  the  chosen  steps 
and  store  the  new  path  for  later  replay. 


CHAPTER  7 
CONCLUSION 


This  dissertation  has  been  concerned  with  some  kinestatic  problems  of  the  hand, 
namely  the  manipulating  ability,  the  special  configuration,  and  the  optimal  grasp.  The 
first  problem  was  to  determine  the  characteristic  matrix  equation  of  the  hand  using  the 
theory  of  reciprocal  screws.  A modified  singular  value  decomposition  was  introduced  to 
analyze  the  dual  matrices  of  the  characteristic  matrix  equation.  This  method,  which  is 
bcised  on  the  theory  of  reciprocal  screws  assures  a complete  invariance  of  the  results 
under  a change  of  origin.  Also,  a novel  method  for  analyzing  the  dual  matrix,  for  the 
case  of  point  contact  with  friction,  is  developed.  This  method  significantly  reduces  the 
number  of  computations.  Software  was  also  developed  to  model  a three-fingered  hand.  A 
straight  line  path,  for  the  grasped  object,  was  also  generated  between  two  positions 
specified  by  the  user.  This  path  can  be  previewed  on  the  screen  and  modified  if  the  user 
wishes  to  do  so. 

7.1  Future  Work 

The  point  contact  with  friction  is  a very  attractive  type  of  contact  that  leads  to  a 
substantial  reduction  of  computations.  However,  it  is  not  possible  to  have  a perfect  point 
contact  between  two  rigid  bodies.  This  is  due,  mainly,  to  the  infinite  pressure  generated 
at  the  local  contact,  which  damages  the  two  contacting  bodies.  Figure  7.1  shows  an 
example  of  a design  of  point  contact.  The  pad  allows  a contact  surface  with  most 
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objects,  and  the  spherical  joint  assures  the  transmission  of  only  pure  forces  between  the 
finger  and  the  object.  This  design  can  still  be  modeled  by  a point  contact  with  friction 
where  the  point  is  located  at  the  center  of  the  wrist.  In  future  work  other  designs  should 
be  investigated  to  preserve  the  same  kinematic  properties  as  the  point  contact  and  at  the 
same  time  be  feasable. 


Figure  7.1 
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Computer  graphics  is  a powerful  tool  that  can  help  the  simulation  of  different 
designs  before  actually  building  them.  The  simulation  of  the  effect  of  gravity  field  on  the 
grasped  object  will  yield  very  realistic  results.  This  area  of  research  is  still  in  its  early 
stages  as  far  as  multi-fingered  hands  are  concerned.  Investigations  of  the  workspace  of 
mechanical  hands  could  also  be  simplified  if  it  is  simulated  using  computer  graphics. 


APPENDIX  A 

THE  SINGULAR  VALUE  DECOMPOSITION  (SVD) 


For  the  sake  of  completeness  a summary  of  the  method  of  the  SVD  (see  Steven 
[1980])  is  given  here  prior  to  developing  a modified  SVD  for  dual  matrices  in  Appendix  B. 
In  this  section  we  will  assume  throughout  that  A is  an  mxn  matrix  with  rank(A)=r  and 
m>n.  (This  assumption  is  made  for  convenience  only;  all  the  results  will  also  hold  if 
m<n).  The  method  involves  factoring  A into  a product  VBU”^,  where  V is  an  mxm 
orthogonal  matrix,  U is  an  nxn  orthogonal  matrix,  and  B is  an  mxn  matrix  whose  off 
diagonal  entries  are  all  O’s  and  whose  diagonal  elements  satisfy 


f>2>  ...  > hr  > 0 


(A-1) 


B = 


0 0 0 0 0 

0 bj  0 0 0 0 

0 0 0 0 0 

0 0 0 br  0 0 

0 0 0 0 0 

0 0 0 0 0 0 


(A-2) 
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B = 


0 


0 

0 


(A-3) 


Bj  is  an  rxr  diagonal  matrix  and  the  bj’s  determined  by  this  factorization  are  unique  and 
are  called  the  singular  values  of  A.  The  factorization  VBU^  is  called  the  singular  value 
decomposition  (SVD)  of  A. 

Let  U = [U^  U2]  where  Uj^  is  an  nxr  matrix  and  V = ¥3  ] where  is  an  mxr 

matrix. 

Consider  the  equation 


A x=  b 


(A-4) 


where  x is  an  nxl  vector  and  b is  an  mxl  vector. 
Since  A = VBU"^,  AU  = VB  and 


[AUi  AU2  ] = [Vi  Bi  0]. 


(A-5) 


Hence  Eq.(A-4),  which  can  be  written  as 

(A-6) 
(A-7) 


BU"^  X = b 
or 

Bi  U[  X = V[  b 


has  the  general  solution 
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X = Ui  b + U2  Y (A-8) 

0 = Vj  b (A-9) 


where  Y is  an  arbitrary  vector  of  dimension  (n-r)xl. 


APPENDIX  B 

THE  MODIFIED  SINGULAR  VALUE  DECOMPOSITION  (MSVD) 


The  procedure  developed  in  Appendix  A cannot  be  applied  to  dual  matrices  such 
as  J,  because  this  transformation  is  based  on  the  formation  of  the  matrix  J^J  which 
involves  the  orthogonal  product  of  screws. 

Lipkin  & Duffy  [1984]  showed  that  the  orthogonal  product  of  screws  is  non- 
invariant with  a translation  of  origin  or  a change  of  scale.  However,  the  reciprocal 
product  of  screws  is  invariant  under  any  projective  transformation  of  3 dimension  space 
and  leads  always  to  meaningful  results.  This  concept  can  be  used  to  modify  the  classical 
singular  value  decomposition,  by  forming  the  following  matrix, 

A = J’^AJ  (B-1) 

where 

T f »(t)  (]>(1)  ffi(l)  (j(M)  ({(M)  (].(M)  , /T, 

J — I ®rl  ^r2  ^3  •••  ^rl  ^2  ^r3  1 


and 


A = 


0 


^3 

0 


(B-3) 
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2S[Sol  Sl'So2  + Sl'So2 


A = 


s[So2+sra 


1^02 


2SJS^2 


(B-4) 


A is  invariant  with  a translation  of  origin.  Further  it  is  symmetric  and  therefore 
diagonalizable.  Hence  a 9x9  orthogonal  matrix  V and  a 9x9  diagonal  matrix  B can  be 
found  such  that 


A = BV 


(B-5) 


bi  0 0 0 0 0 

0 b2  0 0 0 0 


B = 


0 0 0 0 0 

0 0 0 bg  0 0 


0 0 0 0 0 


0 0 0 0 0 0 


(B-6) 


B = 


0 


0 

0 


(B-7) 


Finally  defining  by 
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U'  = J V = [ U 0 ] 


(B-8) 


where  U’  is  a 6x9  dual  matrix  and  U is  a 6x6  dual  matrix,  then 


U = J Vi 


(B-9) 


and 


0 = J V2  (B-10) 

The  modified  singular  value  decomposition  of  the  dual  matrix  J can  thus  be  expressed  in 
the  form 


J = u'v"^  = [U  0] 


(B-11) 


For  the  case  where  J is  singular  i.e.  rank(J)  = r < 6 the  above  analysis  yields 


J = [Ui  I U2  ]V^  (B-12) 

where 

Uj  AU2  = 0 (B-13) 

and 

UJAUi  = Bi  (B-14) 


the  rank  of  U2  is  equal  to  6-r 
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Solution  of  the  Caracteristic  Matrix  Equation 
The  characteristic  matrix  equation  of  the  hand  (see  Equation  (2.2))  is 


Ai  = Kn 


Replacing  J using  (B-11),  yields 


V^U'^A  i = KH 


and  therefore  (see  B-9  and  B-10) 


U'^A  i = V[  Kfi 

and 

a =vjn 

It  can  be  shown  that  the  {iJj  } form  a basis  of  the  space  of  all  possible 
Therefore  it  is  always  possible  to  find  an  X such  that 

$ = UX 

Substituting  (B-19)  in  (B-17)  yields 


(B-15) 

(B-16) 

(B-17) 

(B-18) 

motions. 

(B-19) 


U'^A  UX  = Vj  KQ 


(B-20) 
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From  (B-9) 

U'^A  U = V[  J'^A  J Vi  (B-21) 

and  from  (B-5) 

U’^A  U = Bi  (B-22) 

Substituting  (B-20)  into  (B-14)  and  solving  for  X yields 

X = B'l^  V[  Kn  (B-23) 

Finally  the  solution  of  the  characteristic  matrix  equation  (B-9)  can  be  expressed  by 

i = U B*i^  Vj  Kfi  (B-24) 

together  with 

0 =Vj  Kfi  (B-25) 

Grasping  with  Point  Contact  with  Friction 
In  the  case  of  a point  contact  with  friction  between  the  finger  and  the  object, 
three  forces  can  be  transmitted.  These  forces  can  be  represented  by  three  unit  line 


vectors 
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Si 

S2 

S3 

Il= 

Sol 

S2 — 

So2 

l3~ 

So3 

Where  { Si  » S2  > S3  } is  an  orthonormal  basis  (ONB)  of  R^. 
and  Sol  ~ Ii  ^ Si  ; So2  ~ Ei  ^ S2  ! So3  — £1  ^ S3- 

Let  Rj^=  [ij^x]  a 3x3  skew-symmetric  matrix  representing  the  cross  product  with  the 
vector  which  is  a vector  from  the  origin  to  the  point  contact.  The  vector  Soi  becomes 

Soi  ~ Sh  t i = 1,  2,  3. 

For  another  point  of  contact  on  the  same  object,  three  forces  can  be  transmitted  also 


i = l,  2,  3, 


(B-27) 


where  { Si  5 S2  ^ S3  } can  be  taken  as  an  ONB  of  R^  thus  a rotation  matrix  A2  can  be 
found  such  that 

s[  = A2  Si  ; i = 1,  2,  3.  (B-28) 

S4i=  I2  X s(  = I2  X AsSi  = R-2A2Si  ; i = 1,  2,  3.  (B-29) 


For  the  case  of  three  points  contacting  an  object  the  matrix  J is 


J 


Si 

RiSi 


S2 

Rj^S2 


A3S3 

R3A3S3 


(B-30) 
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The  analysis  of  the  matrix  A = j'^^AJ  can  be  simplified  by  using  the  following  theorem 
(Steven  [1980]): 

Theorem:  Let  A an  mxn  matrix  and  B an  nxm  matrix  (m<n),  then  rank(AB)  = 
rank(BA)  < m,  and  the  set  of  eigenvalues  is  common  to  both  matrices. 

proof:  Let  V an  eigenvector  of  the  matrix  AB  corresponding  to  the  eigenvalue  A,  we 
can  write 


ABV  = AV.  (B-31) 

Multiplying  by  B yields 

B(AB)V  = B(AV)  ==>  (BA)(BV)  = A(BV)  (B-32) 

which  shows  that  the  matrix  BA  has  the  same  eigenvalue  A as  AB  and  the  corresponding 
eigenvector  is  BV  (QED). 

By  virtue  of  this  theorem  the  matrix  J^AJ  and  (AJ)j"^  have  the  same  set  of 
eigenvalues  thus  the  same  characteristic  equation. 

Since  the  matrices  Aj  ’s  are  rotation  matrices  then  Aj  = A|  . 

The  set  of  vectors  { Sj^  , S2  , S3  } is  an  ONB  then 

I3  = Si  S[  + S2  Sj  + S3  Sj.  (B-33) 


The  matrix  JJ^  can  be  expressed  in  the  following  form 
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31, 


JJ”^  = 


r[+rJ+rJ 


Rj  + R2"t"R3  R^Rj^  + R2  R2  "1“  ^3 


(B-34) 


and  since  the  matrices  Rj’s  are  skew-symmetric  then  R|^  = — Rj  which  yields 


= 


31, 


— Rj^  — R2  — R3 


Rj^ -|- R2 -l- R3  — R^Rj^  — R2R2  ^3^3 


(B-35) 


AJJ"^  = 


R]^ -f- R2  "h  R3  — ( B- 1 "h  f^2  ^3  ) 


31, 


— (R]^-f  R2  + R3) 


(B-36) 


Let 


r = 


(B-37) 


where  v and  t/  are  3x1  vectors,  be  an  eigenvector  of  AJJ^  corresponding  to  the 
eigenvalue  A, 


Ajj”^  r = xr 


(B-38) 


and  using  (B-36) 


(Rj^  -l-  R2  "h  R3  ) 2/  — (Bj  -l-  B2  d"  B3  ) V — Av 


(B-39) 
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3v'~  (Ri  + R2  + R3  )i;  = Aj;  (B-40) 

Eliminating  the  vector  between  these  two  equations  yields, 

[3(Rf  + R^  + R§  ) - (Ri  + R2  + R3  f + = Q (B-41) 

and  the  characteristic  equation  can  be  expressed  in  the  form 

DET[3(R?  + R2  + R§  ) - (Ri  + R2  + R3  f + A^Is]  = 0 (B-42) 

This  equation  shows  that  the  eigenvalues  of  the  matrix  J^AJ  which  are  the  the  same  as 
those  for  AJJ^  are  three  pairs  of  form  ( +Aj  , — Aj  ),  j = l,  2,  3.  Further,  the  singularities 
are  independent  of  the  rotation  matrices  Aj’s  and  are  dependent  solely  upon  the  Rj^  , R2  , 
and  R3  , which  represent  the  locations  of  the  contact  points  on  the  grasped  object. 

This  result  can  be  generalized  for  n contact  points,  the  characteristic  equation  for 
which  is 

DET[n(R?  + ...  + r2  ) - (R^  + ...  + f + \\]  = 0 (B-43) 

Equation  (B-41)  yields  three  orthonormal  vectors  corresponding  to  the  three 
eigenvalues  bp,  i=l,2,3  respectively.  The  vectors  corresponding  to  ±bj  are  obtained 

from  Equation  (B-40) 

I 

Uj  = Ruj  + — 


(B-44) 
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- R„  _ ^ 

Vi  — Ruj  2 


where  R = g(R-i  + R2  + R-3) 


Using  Equations  (B-5)  and  (B-9)  yields  the  relations  between  U,  V^,  and  T 


U = pAr 
Vj  = pj'^rBi^ 


where 


(for  the  case  of  three  fingers) 


and 


Bj  — diag(bj^,  — bj^,  b2,  — b2,  b3,  — b3). 


Invariance  of  the  Characteristic  Equation 
Here  the  case  of  three  contact  points  is  considered  and  a proof  by  induction 
formulated  for  the  case  of  n contact  points.  A translation  of  the  origin  from  O 
transforms  the  Rj  matrices  as  follow 

r[  = Rj  + V i = 1,  2,  3 

where  V = [vx],  and  v = QQ^ 

The  new  characteristic  equation  of  the  system  assumes  the  form 


(B-45) 

(B-46) 

(B-47) 

(B-48) 

(B-49) 

(B-50) 

can  be 
to  o' 

(B-51) 


129 


DET[3(R'i^+  R^2)  - (R'i  + R^  + R^)2  + A2I3]  = 0 , (B-52) 

where 

r[2  = R?  + VRj  + R|  V + i = 1,  2,  3.  (B-53) 

and 

(Ri  + R2  + R3 +3V)2=(R^  + R2  + Rg)^ +3V(Ri  + R2  + R3) +3(Ri  + R2  + R3)V +9V2  (B-54) 

Substituting  (B-53)  and  (B-54)  in  (B-52)  yields  (B-42)  which  demonstrates  the 
invariance  with  respect  to  a change  of  origin. 
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